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ABSTRACT 


The goal of this thesis was to build an experimental test rig for demonstrations on 
flexible space systems control. Specifically, an air-bearing test bed incorporated a two- 
degree of freedom (2DOF) rigid robotic arm and an appendage with flexible joints to test 
the effects of movement of the robotic arm on the appendage. The two-link, 2DOF rigid 
robotic arm can be used to simulate a moving space antenna or other movable 
appendages. Optimal trajectories of the two-link arm to simulate a conventional antenna 
slewing maneuver were investigated, to illustrate the type of flexible motion that may be 
produced in the laboratory. An iterative process was used to refine the test bed design and 
the experimental workflow. Three concepts incorporated various strategies to design a 
robust flexible link. Inertia measurement units (IMU), a central processor for data 
analysis, power distribution, and robotics software, are all integrated as part of the test 
bed design. A single link arm with a torsional, helical spring at the base was finalized to 
investigate the effects of coupling due to movement of the rigid two-link arm. The 
torsional spring allowed the vibrating arm to displace sufficiently to have a high signal- 
to-noise ratio compared to earlier concepts in which IMU noise dominated the response. 
The test bed was designed to accommodate further testing that may require increased 
loading due to, for example, the incorporation of reaction wheels or additional 
instrumentation. 
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I. INTRODUCTION 


A. BACKGROUND 

Vibration is defined as “periodie baek-and-forth motion of the partieles of an 
elastic body or medium, commonly resulting when almost any physical system is 
displaced from its equilibrium condition and allowed to respond to the forces that tend to 
restore equilibrium” [1], Aircraft, automobiles, buildings, bridges, etc. all require 
significant consideration to vibration analysis in their design. To minimize vibrations in 
automobiles and improve driver comfort, shock absorbers are incorporated into the 
suspension. Skyscrapers such as Taipei 101 Tower use tuned mass dampers to reduce the 
amplitude of vibrations imposed by forces from wind to earthquakes by absorbing kinetic 
energy [2]. Simply making a system more rigid with more structural components, screws, 
bolts, welds, etc. is another way to reduce vibrations [3]. 

Vibration design consideration for spacecraft is no different. In the launch 
environment, the launch as well as the payload, undergoes significant stresses and 
vibrations. When the spacecraft is on orbit, any appendage movement, such as unfurling 
the payload, an antenna arm slew, camera slewing, or solar panel deployment can impart 
vibrations on the entire spacecraft. Vibrations on a spacecraft affect the components and 
structural integrity, but also, for example, the pointing accuracy of an imaging system or 
an antenna’s communication link. On Earth, a system can generally be fixed or repaired 
in the event of a mishap or complication resulting from excess vibrations; however, after 
a spacecraft is on orbit, one does not have that luxury. Spacecraft and satellites are 
complex systems. Robust spacecraft design and testing must be conducted on the ground 
to ensure the system will continue to operate within specifications during all regimes it 
encounters in its design life. Figure 1 illustrates the complexity of satellite antenna arms 
in the Tracking and Data Relay Satellite (TDRS). 
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Figure 1. Tracking and Data Relay Satellite (TDRS). Source: [4]. 

A challenge with space systems is that it costs a lot of money to put a satellite or 
spacecraft into space. Estimates to send one kilogram of mass into low Earth orbit range 
from $2,720 for a SpaceEx Ealcon 9 [5] to $20,200 for an Atlas V [6]. With this said, 
designing a rigid spacecraft with components used for vibration reduction introduces 
more mass to the system and therefore more cost as well. Alternately, a design choice to 
manage spacecraft vibrations is to control appendage deployment or antenna arm slew 
rates. However, what if a program required a satellite camera to take more pictures as it 
flew from horizon to horizon? What if the specification for the rate of an antenna to 
establish a link with a ground site or other satellite was twice that of previous designs? 

These demands can be met if there is a way to control vibrations without adding 
mass. Eurthermore improving vibration control methods for satellites that are already on 
orbit through software change, and thereby increasing their performance, allows that 
performance to be extended without the costs of designing and launching an entirely new 
system. Developing new motion control systems that optimize movement in a way that 
manages vibrations is indeed possible as evidenced by recent work at the Naval 
Postgraduate School [7], [8]. Numerous papers have been dedicated to the development 
of flexible space systems. In Steven Wojdakowski’s 2015 thesis [7], he developed models 
for two degree of freedom flexible and double gimbal systems. However, there is little to 
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no evidence of work dedicated to building a two degree of freedom system with rigid 
links, yet a purposefully flexible joint in a laboratory setting. 

In order to transition these ideas into practice they must be thoroughly vetted in 
the laboratory. Thus, the goal of this thesis is to develop a laboratory test bed for testing 
the new ideas. 

B. OBJECTIVE AND SCOPE 

This thesis focuses on the development of a simple laboratory test bed that can be 
used to test new ideas for control of flexible space systems. An understanding of the 
concepts is illustrated through the construction of a multi-body system involving a two- 
DOF robot arm mounted to a base plate with a flexible joint appendage also mounted to 
the base plate. In order to produce the forces necessary to observe vibration, three flexible 
joint concepts were developed while incorporating a previously developed two-link 
robotic arm with electric actuators mounted to an air-bearing test bed. The test bed, when 
applied with air pressure, rotates freely when excited. Figure 2 shows the test bed early in 
the development process that was developed, designed, and tested as part of this thesis. 



Figure 2. Laboratory Test Bed Early in the Development Process 
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The test bed provides researehers the eapability of designing and testing eoneepts 
sueh as optimal eontrol methods in a laboratory setting so they ean be transitioned to 
present and future spaee systems. In all experiments and modeling, it is assumed that the 
moving links are rigid; that is, only the joints are eonsidered flexible. Design of these 
joints forms a large part of the development work of the thesis. In all, three flexible joint 
eoneepts were designed to perform the experimentation. The first and seeond eoneepts 
use traditional elastie springs in varying eonfigurations while a third uses a speeially 
machined torsional spring. Additionally, inertia measurement units and an embedded 
computer were incorporated for system response measurement and data analysis. 
Through experimentation, a basis for future thesis work is developed to demonstrate how 
optimal control trajectories can be used to minimize vibrations in spacecraft slewing 
maneuvers. 

Starting with the two-link arm, a standard maneuver will be designed using 
optimal control. The control torques used to move the arm impose a disturbance onto the 
flexible links. To assess this disturbance, a simple model is built. The model parameters 
will be adjusted to help bracket constants for design of a flexible joint suitable for 
laboratory demonstrations. Different approaches can be used to minimize vibrations on 
appendages. Simply reducing the slew rates on an antenna arm, which is common 
practice in industry today, will reduce vibrations. Although not tested in this thesis, the 
optimal control method can also be used with a model of the entire system to reduce 
vibration without reducing slew rates. The test bed is designed to enable experimentation 
to compare and contrast the various techniques. 

C. THESIS OUTLINE 

To demonstrate the background for the test bed Chapter II starts the thesis with a 
discussion of optimal control theory for a 2DOF robotic arm slew through 90 degrees. 
Chapter III uses the torque profile for the time-optimal trajectory found in Chapter II as 
the basis for a model to predict the amount of displacement that can be expected from the 
flexible system for such a maneuver. In Chapter IV, the details of the test bed design and 
assembly are discussed as well as the data processing procedures to measure the vibration 
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response. Finally in Chapter V, the experimental results for eaeh eoneept are illustrated 
ending with a deeision on the appropriate flexible joint and post-proeessing methods to 
be used in future work. Conelusion on future work is diseussed in Chapter VI. 
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II. OPTIMAL CONTROL OF A TWO-LINK ROBOT 


Chapter II investigates time optimal eontrol of a two-link 2DOF, planar arm. To 
begin, the equations of motion for the system are developed. The experimental hardware 
and software used to implement the trajectory is then detailed. Finally, with the equations 
of motion derived and scaled and parameters of the hardware and software incorporated, 
time optimal control methods are examined to produce an optimal trajectory for a 90- 
degree slewing maneuver. The motion profile obtained this chapter is a version of the 
industry standard where each appendage of a spacecraft is considered separate from the 
others. Interaction between the various appendages is not considered. 

A, EQUATIONS OF MOTION 

The equations of motion were developed for a two-degree of freedom (2DOF), 
two-link planar robotic arm to provide a basic model for the movement of a satellite 
antenna or other appendage. It was assumed at present that the links and joints are rigid; 
i.e., a rigid-body system. Figure 3 illustrates the setup. 



Figure 3. Rigid-Body 2DOF Planar Robot. Source; [9]. 
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The kinematic and dynamic equations of motion for the movement of a 2DOF 
planar robotic arm were obtained from reference [9] and are shown in (2.1) and (2.2). It 
was assumed that the movement of the arms was in the horizontal plane, i.e., parallel to 
the ground. Therefore, in the laboratory setup, gravity terms will not appear in the 
equations of motion. By eliminating the gravity terms, this also provides a better proxy 
for space systems considering the lack of gravity in outer space. Additionally, the robot 
arm model is commanded in a comparable manner to a satellite antenna arm. That is, the 
robot arm, like the antenna arm must travel through a certain trajectory to perform a slew 
maneuver from point-to-point. 


The dynamic model of the robot arm is given by [9]; 

^ 11^1 ^ 12^2 ~ ~ ^^2 ~ ^1 (2 1 ) 

^ 22^1 ^ 21^2 ~ ^2 ( 2 - 2 ) 
where r^and T 2 are the torques applied at each joint, S^and 02 are the angles displaced of 
each link Z^and I 2 are the lengths of the links, and 1^2 ^re the distances from the each 
joint to the respective joints center of mass, and and I 2 are the mass moments of inertia 
of each link. Equations (2.3) - (2.5) illustrate the derivation of these values. 

nZjj = /j -h /2 + + ifi2(d^ -H + 2d^d2 cos02) (2-3) 


m|2 = m2i = 4 + '^ 2(^2 +^Zj/2COS02) 


17122 ~ ^2 ^2‘ 


(2.4) 

(2.5) 


The parameter V’ is formulated for convenience from the Christoffel symbols, which are 
used to derive the Coriolis matrix. The Christoffel symbols [8] are given as: 

1 d/Wjj 


Cii 


2 301 


= 0 


( 2 . 6 ) 


— = -m2l.l2 sin 02 

2 30, " ‘" 


(2.7) 


^^122 = ~ ^Uhl. = -m2lyl2 sin 02 

302 2 301 " 


( 2 . 8 ) 
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3m2, 1 3mii ,, • ^ 

c„, = —^-—= sin 02 

301 2 302 

(2.9) 

2 30, 

(2.10) 

_l3m22_ 

2 302 

(2.11) 


The Coriolis matrix is then derived from the Christoffel symbols and defined as: 

f \ 


C = sin 02 


02 01 + 02 


01 0 

V / 

Thus, the parameter V’ is obtained from the Coriolis matrix as 


( 2 . 12 ) 


r = mj.]l 2 sin 02 


(2.13) 


B. LABORATORY PROTOTYPE ARM 

The robotie arm linkage developed in this thesis is shown in Figure 4. 



Figure 4. Prototype Robot Arm 
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The links were created in Solid Works and printed using the Naval Postgraduate 
School’s (NPS) 3D printer of polycarbonate material. The joint actuators are Dynamixel 
Pro actuators; model M42-10-S260-R, from the company Robotis. Each actuator has a 
maximum torque rating of 5.6 Nm and a nominal load speed of 28 RPM [10]. The 
actuators are controlled by the host computer via Robotis Dynamixel Wizard software. In 
Dynamixel Wizard, multiple actuators can be commanded at once to set torque, velocity, 
and position. With these inputs, the user chooses the goal position, and the actuators 
perform the maneuver from point. Other operating modes are available (such as torque 
control); however, position control is the default and most appropriate mode to control 
the actuators. Important to note, there is not a mode that allows multiple commands at 
once, that is, a time series of inputs that would allow a robot arm to perform something 
other than a linear “point A to B” trajectory. To enable this type of commanding, custom 
software needs to be developed to drive the system. Figure 5 shows a screenshot of the 
Dynamixel Wizard user interface. 



Figure 5. Dynamixel Wizard User Interface. Source: [10]. 
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Measurements were made to determine the parameters of the robot. The length of 
the arms was measured to be 33 em and eaeh arm was estimated to be approximately 2.3 
kilograms. The link parameters are summarized in Table 1. 

The mass moment of inertia for eaeh link is ealeulated for a simple beam as: 

(2.14) 

' 12 

where /j denotes the moment of inertia of link i about an axis to the axis of joint rotation 
(see Figure 4) and passing through the eenter of mass of link i. Using the li nk 
measurements given above, / was estimated to /= 0.021 kg-rn . 


Table 1. Estimated Link Parameters of a 2DOF Robot 



Length (m) 

Mass (kg) 

Inertia (k,q * m^) 

Individual Link 

0.33 

2.3 

0.021 


C. TIME OPTIMAL CONTROL OF THE 2-DOF ARM 

Optimal eontrol ean be applied for oases of minimum effort but the ease of 
minimum time oauses the largest disturbanoe to the spaoeoraft. This is beoause minimum 
time solutions are bang-bang in nature. Therefore, for the purposes of this thesis, time 
optimal eontrol was oonsidered. The problem formulation and subsequent derivation 
make use of the methods disoussed in referenoe [11]. 


1, Problem Formulation 


For the dynamio model desoribed in seotion A, the state variables and eontrol 
variables ean be defined as: 


_1 


■ 0 , ■ 

O 2 


02 

01 


Oil 

1 

_1 


1 

3 

_1 





(2.15) 


Optimal eontrol is applied for a minimum time problem by a eost funetional as: 
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(2.16) 




The time optimal eontrol problem uses to the dynamies in (2.1) and (2.2). To form 
the state-spaee model for eaeh link’s aeeeleration, (2.1) and (2.2) are solved for 0^ and 
02 , respeetively as: 


T, m.j Irco.co. rcOj 

a^ = — - -a2 + - — + —^ 


m 


11 


m 


11 


(2.17) 


T, m.o r 2 

a2 =— --ft>i 


(2.18) 


where 0j = rUj and 02 = CO 2 and where 0^=(b^ = and 02 = 0)2 = 0 C 2 - 
By substituting (2.18) into (2.17), we arrive at: 


= 


- -(Tj - T2 + rcof + 2rft)jft)2 + real ) 

_ t/M ' ' 


(2.19) 


Similarly, by substituting (2.17) into (2.18), we arrive at: 


OC 2 


m, 


m 


22 


m 


22 


2rft)jft)2 


m 


m. 


—r(o\-r(ol 


( 2 . 20 ) 


2, Scaling the Dynamic Equations 

Scaling is used to condition the problem numerically. Using the values assumed 
for link length and mass as a length unit and a mass unit, respectively, an inertia unit was 
determined as: 


IU = MU*LU^ 


( 2 . 21 ) 


Since angular rate is a function of angle (referred to as a dimensionless unit of 
radians) an angular rate unit is derived as simply the angle displaced divided by time. 

0 0U 


aU = 


time TU 


( 2 . 22 ) 
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Therefore, we may choose a time unit is used as simply unity. Consequently, a 
scaled torque unit simply becomes an lU divided by unity. Table 2 illustrates the 
canonical units derived from the robot arm problem. 


Table 2. Canonical Units for a Robot Arm Problem 


Length Unit (LU) 

0.33 m 

Mass Unit (MU) 

2.3 kg 

Inertia Unit (lU) 

0.08 kg-m^ 

Torque Unit (TQU) 

0.08 Nm 

Time Unit (TU) 

1 sec 

Theta Unit (0U) 

0 rad 


Consequently, the scaled parameters of the system become: 


(ij 2 = LU * (ij 2 

(2.23) 

m,2 = MU *m^2 

(2.24) 

h.2 = IU*la 

(2.25) 

'^l.2=TQU*f^2 

(2.26) 

(o = (oU*a 

(2.27) 


where (oU = — = 1. 

TU 

The following illustrates the scaling of the dynamic equations: 
For 01 and 02: 


do _ deue _eu de _eu ^ 

(2.28) 

dt ~ dTUt ~ TU dt~ TU 

dU^ 0t/_ 

—0 = coUco = - CO 

(2.29) 

TU TU 

6 =co 

(2.30) 
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(2.31) 


The LHS for (h-y and 0 ) 2 is scaled as: 


" . dco dcoUco coU dco coU - 

9 = CO = — =-^ = -^ = - CO 

dt dTUt TU dt TU 

The RHS for and 0)2 is scaled as (note to reader, recall that terms are inertia 
terms, not mass terms): 

TQUf^-TQUf, 

+MUm2LU\LU\ ^.mO^coU^a^ 


coU 


-CO, 


1 


TU ‘ lUm^^-IUm, 


22 


IMUm^LUl^LUl^LUl^ smOjCoU^cofiO^ 


MUm^LUl^LUl^LUl^ ^.mO^coU^co;) 


(2.32) 


The first term of (2.32) is scaled as: 

TQUTi 


MULW 


TU 


2 '^1 


/f/(mjj-m 22 ) MULU^{m^^-0122) 


(2.33) 


TU 


Dividing through by- gives: 

coU 


MULW 


TU 


2 


MULW 


TU 


TU 


2 h 


TU 


MULU\m,,-m22) (OU MULU\m,,-m22) 


(2.34) 


TU 


All terms cancel leaving: 


(2.35) 


(m,i-m22) 

Similar results are derived for the second term of (2.32). For the third, fourth, and 
fifth terms of (2.32), the first term in the parenthetical expressions are considered only as 
the other terms in the parentheses have the same units. As well, as was done in the 
scaling of the first term of (2.32), the right hand side of (2.36) incorporates the division of 
TU TU^ 


cou eu 


. With this said, (2.36) shows the scaling of the third term of (2.32): 


TW 


eu 


1 


MULU^ (mj j - 0 X 22 ) 


MUm2LUl^LUl2 smO^coU^dol 


(2.36) 


All terms cancel to give: 
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(2.37) 


mj44 sin O 2 ^2 _ f(Oi 
(w„-m22) ‘ (mii-m22) 

In all, the fourth and fifth terms are scaled in a similar fashion to arrive (finally) at the 
scaled equation for cdj: 


£ 0 ; = 0 ; = ^ -'^2 + + 2rC0iCD2 + real) 


(2.38) 


Similarly for £ 02 : 


. X /— ^^22 — ^^22 — — ^^22 —2 — 2 \ /o ^ a \ 

co^=9^ = ——— _ (t^ - - -^Irco^co^ -^^^ 0)2 - (2.39) 


where r is: r = m 2 44 sin 02 • 

The dynamic equations can now be written in their scaled form as: 


0; =£0; 
^2 ~ 


£0; = «! 


- T 2 + r £of + 2 r£ 0 i £<)2 + r £^2 ] 


(2.40) 


£92 = «! = _ 


_ T2“ - '^ 1 “ - 2r£yj£y2-^r£U2-r£Ui 


3. Boundary Conditions 

The boundary conditions for the rest-to-rest motion are modeled as zero critical 
angular velocity and zero final angular velocity for each link. The boundary conditions 
for initial position x-y to final position x-y use the model kinematics based off of link 
length and angular displacement of each link. Equations (2.41) - (2.49) illustrate these 
conditions. 


£Uio=0 


(2.41) 


££>20 0 


(2.42) 


££>1^ = 0 


(2.43) 
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«2/=0 

(2.44) 

COS 6^Q -H ^2 COS(0JO -1- 020 ) = ^0 

(2.45) 

sin 0JO + dj sin(0jo -h 02 o) = y, 

(2.46) 

dj cos0j^ -1- ^2 cos(0j^ + ^2/) = 

(2.47) 

J, sin + sin(0,^ + ^ 2 /) “ 3^/ 

(2.48) 

0 

II 

0 

(2.49) 


The values of Xq, Xf, Jq and y^^were established to establish a joint space trajectory 
moving through 90-degrees. 

In order to solve the optimal control problem, Pontryagin’s principle is applied as 
outlined in [11], A control Hamiltonian is created by relating any running cost function 
and the co-state vectors with the state dynamics. The Hamiltonian is then minimized with 
respect to the control variable to arrive at a relationship between the control variable to 
the co-state dynamics. An intermediate step to develop adjoint equations is then applied 
to determine the co-state dynamics. The concept of transversality is applied by taking the 
partial derivative of the end point cost function and end-point equation with respect to the 
end states to derive relationships that will serve to aid in solving the adjoint equations. 
The Hamiltonian minimization condition uses these results to solve for the ultimate goal 
of the control trajectory. 

4. Formulation of the Hamiltonian 

In formulating the Hamiltonian H — F + f, F is the running cost, k is a vector 
of co-states, and / is a vector of the state dynamics equations. For the case of the time 
optimal control problem, the running cost is zero and the end-point cost, E, is simply tf. 
The Hamiltonian is therefore: 
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(2.50) 




-^(Tj - Tj + rco^ + 2r(Ofi)^ + rcol) 


m2imii-m22mi2 


__ __ _ j _ 9 

-(T2 -^^Ti -r(0 ^) 

mjj mjj mjj 


By observation, the appearanee of eontrol torque in the Hamiltonian is linear. As 
a eonsequenee, when the Hamiltonian is minimized with respeet to eaeh eontrol variable, 
dH 

i.e. the partial - is evaluated, the eontrol torques disappear. Therefore, to obtain an 

3 t, 

expression for the eontrol torques, the Hamiltonian minimization eondition (HMC) is 

dH 

interpreted as a switching function [12]. The torque is defined by the behavior of — = 

5j. As noted earlier, the maximum torque that can be applied by the two-link arm 
actuators is 5.6 Nm. We now evaluate the switching functions. 

For fl from (2.15) we have: 


3Tj mjj-m2 


m2imii-m22mi2 


(2.51) 


which specifies the torque as follows: 


> 0: 


^min 


5’]^ < 0: '^max 


Similarly, for T 2 from (2.15): 


dH ^ ^ 

df^ mii-m22 m2i(mii-m22) 


(2.52) 


giving: 


5^2 > 0. T 2 T-min 


Sy <0: Ty — T 


2 ^max 
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5. 


Adjoint Equations 


With the Hamiltonian minimized the adjoint equations must be ereated to define 
the co-state dynamics equations that allow the switching functions to be evaluated and 
additionally to gain insight to the satisfaction of the conditions of Pontryagin’s principle. 
The adjoint equations are developed as: 

-A = |^ (2.53) 

dx 



Since the equations of motion do not have terms as a function of therefore, we arrive 
at the value above. From (2.54), we can conclude that: 

= constant (2.55) 

What will be found later is that the constancy of the Hamiltonian [11] and the fact 
that Xq^ = constant will be the key indicators for optimality regarding the satisfaction of 
Pontryagin’s principle. 

* dH 

Considering 62 , the adjoint equation —Xg — —, gives many terms due to the fact 

^ 062 

that r = m 2 4 4 sin 02 > which appears in the equations of motion, and subsequently in the 
Hamiltonian. With this said, the equation for —Xg^ becomes very complicated. The 
equation does not give intuition as to the behavior of the co-state trajectory; that is, if the 
plot were that of an optimal or non-optimal solution. Due to the complicated nature of the 
dynamics, similar complicated equations are found for and A^^i therefore, those 
adjoint equations also don’t give a useful way to verify the optimality of the system. 
Additionally, it was illustrated earlier that the switching functions also include the terms 
A^^ and A^^- With this said, the one could compute the values of to check that the 
controls perform in the correct manner. 
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6, Transversality 

The pencil to paper formulation of transversality is conducted for thoroughness, 
but in this case was not needed since the end conditions are known. However, if 
transversality results are not considered with this observation (i.e., that derivation of the 
transversality conditions are not useful) then we know the something may be wrong with 
our problem formulation on our subsequent analysis. 

The steps to developing the transversality conditions are shown as follows. 

(2.56) 

where 5 + v^e(x(ty^)). Equation e{x{tf)) provides the end-point 

conditions. 

Since for the minimum time problem we have; 


ft ), -0 

ft ), -0 

e= ^ 

Jj cos -I- cos(0j^ + ^ 2 /) “ 

Jj sin0j^ -I- sin(0j^ + ^ 2 /) “ 3^/ 

We may write: 

tf+V,CO,f+V^CO^f 

E = -i-VjCJ, cos0,^ -I- cos(0,^ + 02f)-Xf) 

-I-V 4 (d, sin O^f + d^ sin(0, ^ -I- @ 2 / ) “ ) 


(2.57) 


(2.58) 


Taking the partial of E with respect to the state variables at the final time gives: 




dE 


Vjl-J, sin0j^0,^ -I- dj sin(0,^ -I- 02/)0i/) 
-I-V 4 (J, cos+ d^ cos(0j^ -I- 02/ )0i/) 


'^62 (^/) 


dE 


do 


V 3 (-J 2 sin(0j^ -I- 02 ^ )02 f ) + V 4 (^2 COS(0J ^ -I- 02 f )02 f ) 




1 / 




2 / 


(2.59) 

(2.60) 
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(2.61) 




dE 


= Vi 


dE 

dco^f 


(2.62) 


As is seen in seetion 6, eaeh partial derivative provides an u nkn own constant. 
Thus, the analysis does not provide any insight that can be used to validating an optimal 
solution. Moreover, since the transversality conditions provide no new information, we 
may conclude that the boundary conditions for our problem have been properly specified. 


7, Solving the Optimal Control Problem 

To perform the optimal control computation, the program DIDO was utilized 
[11], [13]. The model was coded to allow a trajectory that spanned 360 degrees; that is, 
there were no path constraints. With this said, the scenario illustrated in the following 
discussion addresses the arm moving from a position on the x-y plane of (2, 0) to (0, 2) 
where the distance traveled is in length units (LU). Figure 6 illustrates the trajectory. 



Figure 6. Robot Arm Movement in the x-y Plane 
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Additionally, the model was run using 20 nodes. The values gained from this 
simulation were then used as a “guess” for a simulation using 60 nodes. Using 60 nodes 
allows one to arrive at a more refined solution. 

8, Results 

Figures 7-11 represent the minimum time solution obtained from DIDO for the 
scenario depicted in Figure 6. Figure 7 shows that the maximum torque that could be 
applied to the model is saturated to 5.6 N-m. This saturation value is consistent with the 
bounding value entered into the DIDO code. It turns out that if a higher value of torque 
was allowed in the bounds, a non-optimal solution or non-feasible solution was returned. 
As noted in the boundary conditions section of this chapter, the problem needs reasonable 
bounds for DIDO to narrow its search for the optimal solution. If the range of torques, in 
this case, is too high, there are too many solutions and therefore an optimal solution can’t 
be determined. This infeasibility is true in real life as well. Large amounts of torque 
would cause high stresses on system components leading to increased failure rates. Large 
torques could also lead to large amounts of jitter when attempting to stop an antenna slew 
therefore affecting pointing accuracy. Thus, realistic bounds must always be defined to 
ensure a reasonable solution. 
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Figure 7. Minimum Time Torques versus Time for Trajectory (x,y) = (2,0) to 

(x,y) = (0,2) 
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Figure 8 shows the state dynamics of the optimal control solution overlaid onto 
the validation and verification (V&V) solution. The V&V solution was obtained by 
running the trajectory obtained from DIDO through a numerical model [10]. For the 
V&V, initial values of the states were entered into an ode45 numerical integrator along 
with a new time vector that used smaller incremental time deltas compared to the nodal 
time vector determined by DIDO. This assisted in the interpolation of the DIDO time 
vector. Additionally, the V&V uses the optimal torque vectors (that is the control 
parameters) and propagates them through the state dynamics defined in the problem 
statement. A comparison of DIDO state trajectories and the V&V state trajectories can 
then be seen. Referring to Figure 8, one can see that the model indeed performs in a rest- 
to-rest ma nn er. The variations between the DIDO solution and the V&V could be 
reduced with an increased number of nodes, or by using a feedback controller to 
implement the optimal joint trajectories. 



Figure 8. Minimum Time State Trajectories for (x,y) = (2, 0) to (x,y) = (0, 2) 


23 









One curious observation is the angular displacement, 0 ^, and angular velocity, 
ft), of link one. From Figure 8, one can see that link one does not begin to move until 
approximately 0.75 seconds. This demonstrates an advantage of using computers to solve 
optimal control problems. The obvious solution where one would assume the links should 
always be moving is not always apparent, but with advanced computing power, unique 
solutions that could not otherwise be determined are discovered. 

Figure 9 shows the co-states and that Ag^is constant over the simulation time. This 
constancy is an indicator of optimality in accordance with Pontryagin’s principle. 



Figure 9. Minimum Time Co-states Trajectories for (x,y) = (2, 0) to 

(x,y) = (0,2) 
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Lastly, Figure 10 illustrates a Hamiltonian that is relatively eonstant near a value 
of ‘// = -1’ as would be expeeted for a minimum time problem. The jump mid-way 
through the simulation indicates a non-ideal portion of the solution that typically is 
observed when a switch occurs between the nodes. 


Hamiltonian vs. Time 



Figure 10. Minimum Time Hamiltonian for Trajectory (x,y) = (2,0 

to (x,y) = (0, 2) 
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Figure 11 shows the optimal trajectory overlaid onto the V&V solution in the 
robot task space; i.e., the Cartesian plane. It is interesting to note that the trajectory 
between the start and end points is not an arc, as one would anticipate. From this plot, it 
is also apparent that a simple propagation of the open-loop controls doesn’t move the 
robot’s end-effect to exactly the right spot. Closing the loop (as is done in practice) or re¬ 
solving the optimal control problem with more stringent tolerances (e.g., a higher number 
of nodes) would resolve this issue. 



Figure 11. Minimum Time Robot Trajectory in the Task Space for Movement 

from (x,y) = (2,0) to (x,y) = (0,2) 
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D, 


SUMMARY 


Through formulation of a time optimal slew for a 2DOF, planar robot arm, 
Chapter II established a solution around whieh to model the development of the 
experimental test bed. The optimal trajectory that was determined in this section is an 
example of the power of computers to find a better solution than what our intuition might 
tell us and as such is not exactly the same as the standard maneuver that industry would 
perform. That is, the time optimal path is not simply a great circle rotation, but in fact a 
more elegant path with varying torques at varying time steps to produce a better solution. 
With this said, the model presented in this chapter does not account for vibration analysis, 
but simply provides a basis to see how an optimal path performs as compared to a basic 
rotation of a two link robot arm. As stated in the Introduction to this thesis, one method to 
reduce vibrations is to reduce the applied torque and therefore the slew time for a given 
trajectory. With this said, the time optimal code was run a second time but with a torque 
input to each actuator of 2.8 Nm, or half of the 5.6 Nm maximum available torque from 
the Dynamixel Pro actuators. The resulting time to complete the maneuver was 3.0 
seconds vice 2.1 seconds when 5.6 Nm was applied. Thus, vibrations can be reduced at 
the expense of an increase in maneuver time. In Chapter III, the results of this chapter are 
used to design a flexible joint with the consideration of the maximum torque. For 
comparison of other techniques aimed at minimizing vibrations, the reduced torque 
results will also be analyzed. 
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III. DEVELOPMENT OF A FLEXIBLE JOINT MECHANISM 


Chapter III focuses on the development of the experimental system mechanical 
components, namely a flexible joint for the vibrating appendage. To form a basic 
understanding of the requirements for the flexible joint concepts, the chapter begins with 
a discussion of the test bed’s air-bearing and base plate. From there, a simple model is 
developed to determine appropriate torsional spring rates required to produce a desired 
deflection. Chapter III continues by detailing the various flexible joint concepts that were 
tried before arriving at the concept used to build the final test bed configuration. 

A. AIR-BEARING TEST BED 

With the flexible joints developed for each case, simple simulations were 
conducted to (i) develop the process to analyze data from the test bed sensors, and (ii) to 
get a sense of the response that could be expected from the free-rotating system when 
excited from another robot arm’s motion. 

To begin, a rotary air bearing from Nelson Air Corporation was used to mount the 
support plate [14]. Figure 12 shows the air bearing. An air bearing provides for a near 
frictionless rotation in the horizontal plane. The rotary bearing originally incorporated a 
large magnet in the internal housing to motorize the motion; however, this was removed 
in order to ensure the top disk could rotate freely as in a gravity-free environment. A port 
with tubing is seen in Figure 12 illustrating how pneumatic pressure is applied to the test 
set. When air pressure is applied, between 4.1 - 4.8 kPa (60 - 70 psi) as specified in the 
test specification data sheet [14], the top disk rotates freely on a film of air between the 
two air bearing surfaces. 
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Figure 12. Single Axis Air-Bearing Test Set 
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B. 


BASE PLATE DEVELOPMENT 


An aluminum plate was constructed to mount on top of the air bearing platter. The 
aluminum plate was designed to accommodate robotic linkages on opposite sides of the 
plate as well as to provide tapped holes to allow a means for integrating future 
modifications and experiments. The maximum overall loading of the air bearing is 
specified at 454 kg. The plate diameter design was based off of the air-bearing moment 
loading specification of 1730 kg-cm. From this specification, a plot was created to 
determine how far the test bed center of gravity could be from the center of the plate 
versus the amount of load that can be applied at the center of gravity. Figure 13 shows the 
results. 


Test Bed Loading vs. Center of Gravity 



Figure 13. Test Bed Capacity versus Base Plate Radius 
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Figure 13 illustrates that if the total system center of gravity is 30.5 cm from the 
center of the air-bearing, up to 56.6 kg could be applied at that center of gravity before 
the resulting moment would cause the plate to be out of balance, and therefore, an 
interference in the free-floating rotation of the plate. The total weight of the current 
system is approximately 31 kg and the center of gravity is within 1 cm of the center of the 
plate. Therefore, even if the system center of gravity were more than 30.5 cm from the 
center of the plate, there would not be an imbalance. In the end, a 30.5 cm plate radius 
was chosen due to two reasons: the plot shown in Figure 13 and the amount of space that 
the system would encompass in the laboratory. Furthermore, Figure 13 shows that there 
is a significant margin between the current mass and the maximum bearing load to add a 
second level incorporating additional components. 

Figure 14 illustrates a top view of the aluminum base plate when mounted on the 
air-bearing test set. 



Figure 14. Aluminum Plate that Supports Robot Arm and Flexible Appendage 
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c. 


MODELLING APPENDAGE VIBRATIONS 


The estimated mass-properties as outlined in Table 1 were used to determine the 
dynamies of the robot arm. Calculations were based on a simple beam model and do not 
account for actual design intricacies. The same geometric model was used to determine 
an appropriate value for a torsional spring rate so a one-arm link, with the flexible joint, 
excited by the two-link arm with electrically actuated joints would produce an easy to 
visualize vibration of approximately 19 degrees +/- 5 degrees. For the initial cut, a 
constant torque was applied to get a sense of how the system may perform. Subsequently, 
the optimal control profile was run to evaluate how that trajectory excites the vibration. 
The main point behind the large range of motion is to visually show the motion of the 
one-arm link flex. Figure 15 illustrates the simple torsional mass-spring model formed by 
a rigid plate attached to a spring that can be used to estimate the vibration amplitude. 



Figure 15. Simple Torsional Mass-Spring System 

The equation of motion is simply derived as: 

T = ie + ke (3.1) 

and, transformed into the Laplace domain becomes: 

= + k)0(s) /o ON 


33 


The open-loop transfer function from input to output is: 


G(s) = 


m 

F(s) 


1 

Is^ + k 


A Simulink implementation of this model is illustrated in Figure 16. 


(3.3) 



Scope! 

Figure 16. Simulink Model for Simple Mass-Spring System 


In this model a constant input of 5.6 Nm was applied to system for 2.1 seconds 
then the applied torque is commanded to zero. The time frame of 2.1 seconds is the 
optimal time determined in Chapter II for the robotic arm maneuver. By turning the 
torque off after 2.1 seconds, the system is allowed to settle. For the initial analysis, each 
simulation was run for 15 seconds. The torque value of 5.6 Nm is the maximum torque 
capable of the Dynamixel Pro actuator. Figure 17 shows the response of a flexible link 
with k = 3.39 deg/Nm and / = 0.21 kg-m^. The torsion spring rate was determined by 
simply dividing the desired deflection by the applied torque. 

19 deq 

k — — -= 3.39 deg/Nm 

S.6 Nm 
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Figure 17. Angle and Rate Response of Flexible System Model when Subjected 
to 5.6 Nm of Torque Using Torsion Spring Rate of 3.39 deg/Nm 


Referring to Figure 17, one can clearly see that for the constant input used, the 
approximated displacement would be over 35 degrees. This response would be too large 
compared to what was desired. Moreover, only one actuator on the two-link arm was 
considered in Figure 17 so the flexible motion would be much larger if the time optimal 
solution was implemented. 
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As a comparison to other techniques used in industry to minimize vibrations of 
flexible space systems, the optimal control model presented in Chapter II was run with an 
applied torque of half of the maximum torque available from the Dynamixel Pro 
actuators. The time to complete the maneuver of the planar, 2DOF robot arm increases 
from 2.1 seconds to 3.0 seconds with torque reduced from 5.6 Nm to 2.8 Nm. The 
reduced torque was entered into the same model used to produce Figure 17. Figure 18 
illustrates the results. 




Figure 18. Response of Flexible System Model with Torque Reduced to 2.8 Nm 

By comparing Figures 17 and 18, one can see that the torque reduction (with its 
unavoidable increase in slew time) does reduce the vibration displacement as well as the 
magnitude of angular rate. This technique is satisfactory to reduce vibration, but for our 
interests, faster slew times coupled with minimized vibrations are desired. 
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To find an appropriate spring rate for the flexible joint, the time optimal control 
trajectory developed earlier was approximated using three steps. The torque of each 
actuator from the time-optimal control trajectory was added together to give the 
approximated optimal control torque profile illustrated in Figure 19. 



Figure 19. Approximate Torque Trajectory Compared to Total Time Optimal 

Control Torque Trajectory 
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This step-wise approximation can be seen to be a sufficient model of the system 
and to allow spring rates to be adjusted to obtain the desired deflection. Figure 20 
illustrates the results for a torsion spring rate of 1.7 deg/Nm. The torsion spring rate was 
determined by simply dividing the desired deflection, 19 deg, by the combined applied 
torque of two actuators, 11.2 Nm. 


19 deg 
11.2 Nm 


1.7 deg/Nm 




Figure 20. Angle and Rate Response of Flexible System Model when Subjected 
to the Torque Profile of Figure 19 Using a Torsion Spring Rate of 

1.7 deg/Nm 


The overall angle response in Figure 20 still was larger than required: over 35 
degrees. The model was run again, halving the 1.7 deg/Nm spring rate to 0.85 deg/Nm. 
Figure 21 illustrates the results. 
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Figure 21. Angle and Rate Response of Flexible System when Subjected to the 
Torque Profile of Figure 19 Using a Torsion Spring Rate of 

0.85 deg/Nm 

In Figure 21 one can see that the desired initial response of approximately 19 
degrees is achieved. The model does show the angle trajectory displacing over 25 degrees 
in the opposite direction. However, the simple model of the system with the spring rate of 
0.85 deg/Nm was considered sufficient to proceed with the joint design and sizing of 
various options for the flexible link. These options are described in section D. 

D. CONCEPT A—JOINT WITH TWO COUNTER SPRINGS 

Concept A was inspired by a YouTube video describing an experiment using a 
flexible joint [15]. The experiment in the video uses control methods to minimize the 
vibrations of an appendage. Exact methods to control the appendage vibrations were not 
described, but the experimental set up provided an initial concept from which to design a 
flexible joint. Figure 22 is a simple sketch of the set up. 
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Figure 22. Simple Sketch Illustrating Flexible Joint for Concept A 

This concept was developed as one possible means to evaluate the response 
imparted on the one-link arm from the two-link electrically actuated arm. A key feature 
to this design, and the two other concepts described in sections E and F, is this use of 
bearings as part of the joint. The bearings shown in Figure 23 are typically used with the 
actuators that are implemented on the two-link robot arm to allow appendage rotation. 
The repurposing of these bearings allows for smooth rotation to the flexible joint 
concepts [16]. 



Figure 23. Photograph of Dynamixel Pro Bearing Used for Flexible Joint 

Concept Designs. Source; [16]. 
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It should be noted that, though the bearing does rotate freely, there is still frietion 
in its mechanism. The ball bearings that allow the bearing to rotate may become damaged 
or dirt may become stuck in the rotating component introducing non-linearities to the 
system. At the very least, they introduce drag that will reduce the amplitude of the 
vibration over time. Figures 24 and 25 illustrate the developed prototype of concept A. 



Figure 24. Concept A—Side View 



Figure 25. Concept A—Side View Close-up 


41 

























Concept A seemed to be simple enough in the sketching phase. The main idea 
was to attaeh two extension springs on the outboard sides of the mount and arm. The 
eoneept may be simple on paper, but the aetual build proved to be more diffieult. As one 
ean see from Figure 25, in order to ehange the spring to investigate varying spring 
eonstants and therefore different responses, the mount and arm have to be taken apart. 
This is a time eonsuming proeess. As well, in early experiments to test the basie 
funetioning of the eoneept, the springs were observed to buekle in eompression; that is, 
become eoneave with respeet to the outside edge of the mount and arm. When the springs 
buekled in sueh a fashion, it was assumed that non-idealities would influenee the 
response. As will be discussed later, the aetual response appeared more linear than 
expeeted. Table 3 lists the springs that were utilized for initial experimentation. 


Table 3. Springs Considered for Coneept A 


Length (em) 

Outside diameter (em) 

Wire diameter (cm) 

Spring rate (kg/m) 

1 

0.478 

0.0406 

8.95 

1 

0.478 

0.0508 

29.2 

1 

0.478 

0.0635 

98.5 


To get a sense of the response using the spring rates noted in Table 3, the 
torsional mass spring system was adjusted to aeeount for the faet that the extension 
springs are being used. With this said, the foree transmitted aeross the plate replaeed the 
torque term by simply dividing the torque trajectory by the distanee between the bases of 
the two-link arm and the one-link flexible joint arm. As well, the inertia term was 
replaeed by mass. Figure 26 illustrates the response for a spring rate of 29.2 kg/m with a 
maximum defleetion of 3 em. 
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Figure 26. Simulated Response of Concept A Using a Spring Rate of 

29.2 kg/m 

The amount of linear deflection corresponds to approximately +/-5.2 deg when 
the deflection is considered at the end of the 33 cm vibrating arm as shown is Figure 27. 
The displacement in Figure 26 corresponded visually to initial experimentation of the 
system leading to an initial conclusion that the simple model provided a good 
approximation of the actual system response to robotic arm movement. 

3 cm 

3 cm 

33 cm 

Figure 27. Displacement of Vibrating Arm 
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Due to the difficulty of assembling concept A, only one spring set was tested. In 
the end, the main purpose of this prototype was to provide an initial test of the concept. 
Although it did not produce a large amount of deflection when perturbed, it proved to be 
useful in the overall laboratory build as will be seen later. 

E. CONCEPT B—SPRING FLEXION PIN 

Concept B built upon the idea of concept A as a more rigid, interchangeable 
design. For this concept, a pin is routed through posts on both sides of the mount and in 
the middle through a tongue formed via 3D modeling into the arm. Grooves were created 
on the inside portion of the post and both sides of the tongue to provide a base for springs 
to rest, and therefore not slip and rub against the pin during the experiment. It should be 
noted; rubbing of the spring against the pin could not be avoided since in compression, 
the spring will want to naturally bend. With this said, the bending is far less then what is 
allowed for in concept A and should help to achieve a more linear response. 
Figures 28-31 illustrate the prototype of the improved setup. 



Figure 28. Concept B—Side View 
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Figure 29. Concept B—Top View 



Figure 30. Concept B—Forward-Looking View 
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Figure 31. Concept B—Pin/Spring Arrangement Close-up 


One key factor in the design of the tongue (see Figure 31) was to provide enough 
fore/aft room for the arm to displace under excitation and not hit the pin. To ensure this, a 
MATLAB script of basic trigonometry was coded to design the proper dimensions of the 
tongue hole. In this code, the goal is to ensure the hole is large enough so the outside 
edge of the tongue does not hit the pin when the arm is maximally displaced. The wider 
the tongue, the better chance that the tongue would impact the pin; therefore, the tongue 
was designed to be 1.27 cm in width. If the tongue were any thinner there was concern 
that the stresses from the spring compression may break the tongue or at best, bend it. 
The other piece of the design in considering hole size is the pin size. The pin diameter 
was chosen to be 0.64 cm based on the size of the height of the tongue coupled with 
spring’s size that could fit well and provide an appropriate response. Considering this, the 
smaller the hole, the less allowance for displacement. Table 4 illustrates the point. The 
fore/aft displacement must be less than the hole diameter minus the pin diameter. In 
Table 4 this value is shown as the margin available for each hole diameter. The red 
values indicate when the end displacement will cause the margin for a particular hole 
diameter and the pin will be exceeded. 
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Table 4. Total Displacement of Clearance Hole (cm) for Concept B 



Varying Hole Diameter 


0.76 

cm 

1.012 

cm 

1.27 

cm 

1.52 

cm 

1.78 

cm 

2.03 

cm 

Margin 

0.064 

0.19 

0.32 

0.45 

0.57 

0.70 

End Displacement 







2.54 cm 

0.046 

0.046 

0.048 

0.048 

0.048 

0.048 

5.08 cm 

0.130 

0.137 

0.140 

0.142 

0.145 

0.150 

7.62 cm 

0.267 

0.274 

0.279 

0.287 

0.292 

0.30 

10.2 cm 

0.442 

0.455 

0.465 

0.478 

0.488 

0.50 

12.70 cm 

0.660 

0.678 

0.696 

0.716 

0.732 

0.752 

15.24 cm 

0.922 

0.947 

0.975 

1.001 

1.026 

1.054 


The shadowing in Table 4 illustrates for the end of the link to displace at least 
10.2 cm (which equates to approximately 19 degrees) the hole diameter would need to be 
at least 1.78 cm in diameter (refer to the shaded row and column of Table 5). Considering 
the tongue was designed to be 2.54 cm in height, this was determined to be too large of a 
hole due to the strength of the material being used. That is, considering the amount of 
force the spring exerts on the tongue, by removing more material to create a bigger hole 
reduces the tongues ability to not bend or break during an experiment. In the end, the hole 
in the tongue was sized to be rectangular; 0.762 cm in height to accommodate the 0.635 
cm pin diameter and 2.54 cm wide to allow for travel of the tongue without chance of 
interference with the pin. Table 5 lists the springs that were utilized for experimentation 
with the concept B prototype. 


Table 5. Springs Considered for Concept B 


Length (cm) 

Outside diameter (cm) 

Wire diameter (cm) 

Spring rate (kg/m) 

3.175 

0.762 

0.0813 

154.0 

3.175 

1.156 

0.991 

146.8 

3.175 

0.914 

0.104 

248.8 
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As in concept A, to get a sense of the response of the spring rates noted in Table 
6, the torsional mass spring system parameters of inertia and torque were replaced with 
mass and foree, respectively, to aeeount for the fact that extension springs are used. 
Figure 32 illustrates the response for a spring rate of 154.0 kg/m with a maximum 
deflection of just under 0.3 cm, which is less than a degree of deflection for the 33 cm 
vibrating arm. As in concept A, the displacement in Figure 32 corresponded visually to 
initial experimentation. Therefore, to use this design concept much lighter springs would 
need to be used. 



Figure 32. Displacement Modeling of Concept B Model with a Spring Rate of 

154.0 kg/m 

Again, the displacement from the model was far from the desired defleetion of 19 
degrees, but as will be seen in the next chapter, the motion indueed on this link on the 
laboratory test-bed is sufficient to provide an understanding of the dynamics and 
vibration effects associated with spacecraft robot arm slews. 
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F. 


CONCEPT C—MACHINED TORSION SPRING 


The concept of using a machined spring for the flexible joint was inspired by the 
website of Helical Products Co. based out of Santa Maria, California [16]. Helical 
specializes in engineering helical machined springs to produce desired amounts of torque 
and flexion. An advantage is that attachment points are (can be) integrated into the spring 
for mounting. These attachment points allow for simple assembly of the torsion spring 
joints by allowing one end to be fixed while the other end is mounted to a bearing or 
some device that allows the spring to be torqued. This concept enables a pure moment 
and linear rates to be transmitted to the vibrating arm. As such, this concept may prove to 
be the best option for a lab demonstrator. Figure 33 shows an example of the Helical 
product. 



Figure 33. Example of a Helical Machined Spring. Source; [16], [17]. 

The full construction of concept C was delayed due to spring manufacturing lead- 
time and logistics; therefore, experimentation using this concept was delayed as well. 
With that said, initial parts for the concept C joint were created using the 3D printer and 
the prototype can be seen in Figures 34-36. Figure 37 illustrates the assembled design as 
created in the computer aided drawing program, Nx. 
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Figure 34. Concept C—Side View 



Figure 35. Concept C—Top View 
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Figure 36. Concept C—Bearing Insert 



Figure 37. Concept C—Nx Model Front View of Link Mount with Simple Model 

of Machined Spring Inserted at the Joint 


51 





























The parameters in Table 6 were provided to Helieal engineers to provide a base 
estimate for performance capabilities and cost. 


Table 6. Concept C Torsion Spring Requirements 


Moment arm 

30 cm 

Total torque applied to two-link arm 

11.2 Nm 

Mass of one-link arm 

11kg 

Deflection required 

+/-10 cm 

Spring Length 

5.08 cm 

Outside diameter 

3.56 cm 


When the design materialized, the torsional spring rate provided from Helical was 
3.39 deg/Nm. The spring rate simply was derived by dividing the required deflection, in 
degrees, divided by the torque applied from one Dynamixel actuator. Figures 38 and 39 
show a side and top view of the finished helical machined spring. 



Figure 38. Side View of Helical Machined Spring Manufactured for Test Bed 
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Figure 39. Top View of Helieal Maehined Spring Manufaetured for Test Bed 

When the spring arrived, it was apparent from handling it that it was too stiff to 
produee the desired defleetion. The spring was assembled in the mount, but as expeeted, 
the amount of torque to produee any defleetion, let alone the desired defleetion, was not 
obtainable from the system. Unfortunately, the torsional spring rate determined from the 
simple modeling did not aeeurately represent the experimental system. The test bed is a 
complex, multi-body dynamical system. It is believed that the main error in the modeling 
was not accounting for the mass of the base plate. The base plate and components have a 
mass of approximately 31 kg compared to just 4.6 kg for the robot arm and 2.3 kg for the 
vibrating arm. In reality, the relatively small forcing function from the robot arm was 
simply not sufficient to overcome the significant plate inertia and induce the amount of 
deflection desired. 

The spring was therefore taken to the NFS machine shop. The machinist was able 
to remove material from the outer diameter to create a “neck” in the spring. Figure 40 
shows a before and after comparison of the machined spring. The fully assembled 
concept C prototype is shown in Figure 41. 
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Figure 40. Comparison of Flelical Machined Spring before and after 

Material Removed 



Figure 41. Concept C—Fully Assembled 
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When assembled the maehined spring allows for deflection of approximately +/- 
10 degrees. This result proves to be more than sufficient to visually appreciate the 
deflection of the vibrating arm as compared to concepts A and B. As well, since the 
machined spring now produces this larger deflection coupled with the pure moment and 
linear rates from a machined spring, there is confidence that concept C is the preferred 
choice for future experimentation. 

G. SUMMARY 

The main purpose of this chapter was to document the development of various 
concepts for realizing a flexible joint that could be used in experimentation of flexible 
space systems development for not just this but for many future theses. The development 
of each concept proved to lay the ground for the experimentation process and data 
analysis moving forward. 

Concept A was a simple, initial prototype to conduct initial experiments of the 
system. Concept was a more elegant design that allowed for different spring rates to be 
tested easily. However, neither of these concepts produced the desired deflection of 19 
deg. Concept C incorporated a helical machined spring that was benefited with pure 
moments and linear rates. The helical spring proved to be the best of the three concepts to 
produce the desired deflection for future test bed experimentation. 
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IV. SENSOR INTERFACING AND DATA PROCESSING 


In this chapter, the sensors and embedded eomputer implemented on the 
laboratory test bed are introdueed in detail. Additionally, the post-proeessing proeedures 
that were developed during the eourse of the thesis will be deseribed ineluding the 
diffieulties eneountered and the methods that were derived to mitigate these ehallenges 
and ultimately provide the most effieient and aeeurate means of analyzing the data after 
experimentation. 

A, INERTIAL MEASUREMENT UNIT 

In order to analyze the exeitation imparted on the vibrating arm with the flexible 
joint, the robotie arm, and the plate, an inertial measurement unit (IMU) was mounted at 
the end, side faee of eaeh arm and near the outer edge of the plate, respeetively. The IMU 
used is the nine-degree of freedom (9DOF) Razor Inertial Measurement Unit developed 
by the eompany “Sparkfun” [18]. In addition to an aeeelerometer in all three axes, the 
Razor has a magnetometer and gyroseope for eaeh axis. The aeeelerometer in the Razor, 
the ADXL345 [19] is eapable of sensing aeeelerations up to a maximum of 10,000 gs, far 
more than the aeeelerations to be observed in this test laboratory. The ITG-3200A 
gyroseope has a full-seale range of +/-2000 °/seo [20]. The Razor is shown in Figure 42. 
Figure 43 illustrates where eaeh IMU is loeated in the final test bed eonfiguration. 
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Figure 42. 9D0F Razor IMU. Source [18]. 



Figure 43. IMU Placement for Final Test Bed Configuration 
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B, CALIBRATION 

Before the IMUs ean be attaehed to their respective positions, each accelerometer 
and gyroscope must be calibrated. Sensor calibration is required to account for minor 
defects in the sensor due to manufacturing, assembly, etc. An IMU that is not calibrated 
can affect precision and responsiveness of the IMU such as drift in yaw when roll is 
applied to the board [18]. The calibration factors that are determined through the 
calibration process help to alleviate these minor defects that are particular to each IMU. 

The procedures are detailed in a tutorial linked via the Sparkfun website [18]. To 
perform the calibration, each IMU was connected to an FTDI breakout board and then to 
the user’s laptop via a USB cable. The FTDI breakout board receives the raw data from 
each sensor and routes that data through an embedded integrated circuit (IC). Now that 
the data is packaged neatly on the IC, the serial data is transferred to the host computer 
via a USB cable [21]. The program Arduino [22] was used to read the data off of the 
IMU as well as to perform the calibration. The process to calibrate the accelerometers 
was the most difficult and time consuming. The basic procedure was to find the 
maximum and minimum readings for each axis in a static test. The maximum / minimum 
values corresponded to a gravity measurement of Ig. To perform the calibration, the user 
held the IMU steady to begin the process and then slowly rotated the IMU to find the 
maximum and minimum values. Moving the IMU slowly so as to not induce excess 
accelerations was the difficult part. With this in mind, the process was performed three 
times to find an average maximum and minimum value for each axis. Figure 44 
illustrates the captured sensor output during the acceleration calibration. 
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Figure 44. Example Data for Accelerometer Calibration. Source; [22], 
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The average values were then entered into the Arduino eode by replaeing the 
baseline values of +/-256 LSB. Figure 45 shows the loeation in the Arduino interfaee 
where the user enters the aceelerometer ealibration data. In Figure 45 the baseline 
accelerometer values are shown; that is +/- 256 LSB. 





J Razor.AHRSS 

Compass ! DCM 

I 

Math 

Output 

Sensors 



// It is not necessary to set this! It just makes life easier when writing cod 
// the receiving side. The Processing test sketch also works without setting t 
// NOTE: When using this, OUTPUT_STARTUP_STREAM_ON has no effect! 

#define OUTPUT_HAS_RN_BLUETOOTH false // true or false 


// SENSOR CALIBRATION I 

// How to calibrate? Read the tutorial at httn://dev.aii.tij-ber1 in.de/oroiects/ 
// Put MIN/MAX and OFFSET readings for your board here! 

// Accelerometer 

// "accel x,y,z (min/max) = X_MIN/X_MAX Y_MIN/Y_MAX Z_MIN/Z_MAX'' 

#define ACCEL_X_MIN CCfroat) -256) 

#define ACCEL_X_MAX (Cfloat) 256) 

#define ACCEL_Y_MIN CCfioat) -256) 

#define ACCEL_Y_MAX (Cfloat) 256) 

#define ACCEL_Z_MIN ((float) -256) 

#define ACCEL_Z_MAX gCfloat) 256) 

11 

o 


221 Arduino Pro or Pro Mini, ATmega328 (3.3V, 8 MHz) on /dev/cu.usbserial-A40083NG 


Figure 45. Coding the Accelerometer Arduino Interface. Source: [22]. 
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Figure 46 illustrates how the calibration is changed in the code. Note the changes 
to each axes’ minimum and maximum values. 




Razor AHRS 


Compass 

DCM 

Math 

Output 

Sensors 


// the receiving side. The Processing test sketch also works without setting t 
// NOTE: When using this, OUTPUT__STARTUP_STREAM_ON has no effect! 

#define OUTPUT_HAS_RN_BLUETOOTH false // true or false 


// SENSOR CALIBRATION 

/Ht****************************************************************/ 

// How to calibrate? Read the tutorial at http://dev.au.tu-berlin.de/oroiects/ 
// Put MIN/MAX and OFFSET readings for your board here! 

// Accelerometer 

// "accel x,y,z (min/max) = X_MIN/X_MAX Y_MIN/Y_MAX Z_MIN/Z_MAX" 

#define ACCEL_X_MIN CCfioat) -289) 

#define ACCEL_X_MAX CCfLoat) 238) 

#define ACCEL_Y_MIN CCftoat) -272) 

#define ACCEL_Y_MAX CCfioat) 260) 

#define ACCEL_Z_MIN CCfioat) -271) 

#define ACCEL_Z_MAX CCfioat) 252) 


o 


Arduino Pro or Pro Mini, ATmega328 (3.3V, 8 MHz) on /dev/cu.usbserial-A40083NG 


Figure 46. Coding the Accelerometer Calibration Factors. Source; [22]. 


After the accelerometer, the magnetometer is calibrated. To begin, the direction to 
North is determined. The x-axis of the IMU is pointed to North and then rotated about the 
East-West direction. Similar to calibrating the accelerometer, the IMU is then tilted in 
every direction until a maximum value is obtained, then the IMU is pointed in the 
opposite direction, and the IMU is titled to now find the minimum values. A similar 
process is performed for the y and z-axes. Each axes values are recorded and entered into 
the Arduino calibration code in place of the baseline values of 600 LSB. 

After the magnetometer, the gyroscope is calibrated. This process is much 
simpler. The gyroscope is simply held steady for a minimum of ten seconds or until the 
values in each axis are steady. The steady values represent the gyroscope drift rate. Once 
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steady, the outputs are noted and entered in the Arduino code in place of gyroscope 
baseline values of 0.0 LSB. The gyroscopic data is in units of LSB. Tables 7, 8, and 9 
show the average calibration results. 


Table 7. Accelerometer Calibration Data 



X (LSB) 

Y (LSB) 

Z (LSB) 

Plate (min/max) 

-289/238 

-272 / 260 

-271 /252 

Vibrating Arm 
(min/max) 

-269 / 266 

-270 / 293 

-282 / 246 

Robot Arm 
(min/max) 

-272 / 254 

-254 / 265 

-298/238 


Table 8. Magnetometer Calibration Data 



X (LSB) 

Y (LSB) 

Z (LSB) 

Plate (min/max) 

-381 /427 

-571 /394 

-326 / 460 

Vibrating Arm 
(min/max) 

-399/459 

-509/461 

-295 / 602 

Robot Arm 
(min/max) 

-392/512 

-439 / 422 

-495 / 466 


Table 9. Gyroscope Calibration Data 



X (LSB) 

Y (LSB) 

Z (LSB) 

Plate 

0.21 

24.66 

33.13 

Vibrating Arm 

-8.37 

57.62 

23.03 

Robot Arm 

-2.61 

38.56 

11.16 


The sensitivities for each sensor, accelerometer, gyroscope, and magnetometer, 
were obtained from the respective data sheets. The accelerometer, gyroscope, and 
magnetometer data is given in LSBs. The data is then divided by the sensitivity factor for 
each sensor. Table 10 shows those factors. 
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Table 10. IMU Sensitivity Factors 



Sensor Sensitivity Factor 

Converted Units for Post- 
Processing 

Accelerometer [23] 

256 +/- 30 (FSB/g) 

Gravity 

Gyroscope [20] 

14.375 FSB/°/sec 

°/sec 

Magnetometer [24] 

230 - 1370 FSB/gauss 

Gauss 


The magnetometer sensitivity factor is given for completeness. Ultimately the 
magnetometer was not used in the post-processing analysis, but was used only for the 
calibration process and to aid in evaluating the accuracy of the yaw, pitch, and roll 
measurements discussed in Chapter IV. 

The IMUs were then attached to the system in their respective locations. A static 
test was the conducted to observe the accelerations along the tangential axis at the end of 
the arm and the outer edge of the plate. The vertical and normal axes were ignored since 
the primary motion of concern was in the horizontal plane, which is, vibrating motion. 
With this said, when the static tests were performed, it was expected that, after the 
calibration, the tangential axis accelerations would be near zero. If the values were not 
near zero, small refinements to the average calibrated values were entered until the static 
accelerations were observed as near zero. Even after this was completed, noise in the 
sensor was observed so as in a static condition the accelerations fluctuated +/- 2.0 LSB. 
When divided by 256 LSB/gravity, this gives a small fraction of gravity (0.0078 gs) 
imparted as the noise. What will be shown in the experiment results in Chapter V is that 
the noise was more apparent in concepts A and B due to their relatively small vibrating 
displacement compared to concept C. 

After the calibration is complete, the user configures the Arduino output code so 
the displayed values only reflect what the user requires. Figure 47 illustrates the output 
code tab of Arduino. For example, if the Arduino output code were not changed, the yaw, 
pitch, roll angles and accelerations in all axes would be displayed. As will be discussed 
later in section E, the post-processing for concepts A and B were completed with the 
user’s laptop computer whereas concept C incorporated a more robust system design 

incorporating the National Instruments cRIO 9024 embedded computer [25], discussed in 
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section D of this chapter. With that said tangential accelerations were only analyzed in 
concepts A and B for system initial development, and tangential and normal accelerations 
as well as gyroscopic data was captured for concept C. In Figure 47 the script colored 
orange represents the serial data that will be displayed. In this case all three axes of 
acceleration and all three axes of gyroscopic data are displayed. 



// Output angles: yon, pitch, roU 
-.■O’.- CPutput_ongXesC) 

{ 

if (output.format -- OUTPUT_FOP><AT_BINAftT) 

{ 

■ l;c.L >pr[3]; 
ypr[0] - T0.C€GCyo»<); 
ypr[l] . TO.CtGCpitch); 
ypr[2] - TO.DCGCroU): 

S*rioI,write(( ypr, 12); // No rtew-line 

} 

else if Coutput_fonnat ■- OUTPUT_FOfi><AT_TEXT) 

{//Seriol.printC"-TPR- ”); 

//Serial.pnntCTO.DEGCycw)); Senol.prmtC" "); 
//Seriol.printCTO.DEGCpitch)); Serial.print(" 
//Seriol.printCTO-DEGCroll)); Seriol.printlnC); 

// Seriol.printCTO-OEGCroll)): Seriol.printC" "); 


Serial .printCaccel[0]); Serial.printf ”); 
Serial. printCaccel[l]); Serial.printC* "): 
Serial. printCaccel [2]); Serial.printf* ”); 

Seriol. printCgyro[0)); Serial.printC "); 
Seriol .printCgyro[l]); Seriol.printC “); 
Seriol .printCgyro[2]); Seriol.printC 
Seriol .print("\n"); 


User defined 
output block 


Figure 47. Arduino Output Code. Source; [21]. 


C. NATIONAL INSTRUMENTS CRIO CONTROLLER 

In order to build a test bed interface that could monitor and control several 
devices at once, it was decided to incorporate an embedded computer onto the center of 
the plate to act as a central hub of information control. The device chosen to perform this 
task was the National Instruments cRIO model 9024 [25]. This model is a real-time 
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controller with specifications of 800 MHz, 512 MB DRAM, and 4 GB of storage. It is a 
real time embedded eontroller that runs the program LabVIEW “for real-time 
deterministic control, data logging, and analysis” [26]. Additionally, the ehassis that 
holds the cRIO has four slots for serial interface modules. Three NI 9870 serial interface 
modules were used. Each module has four ports that connect to the IMEls via an RS232 
connector. Additional ports allow future expansion of the test bed to incorporate up to 16 
serial data components. Eigures 48 and 49 illustrate the configuration of the embedded 
system. 



Eigure 48. NI CRIO 9024 Configuration 
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Figure 49. NI CRIO 9024 Close-up 

The eRIO allows the user to monitor all IMU measurements at one time as well as 
providing a means to implement the optimal control trajectory to the robotic arm. This is 
a great advantage since the Arduino software allows the user to monitor just one IMU at a 
time. Moreover, the Robotis Dynamixel Wizard software does not provide a means to 
incorporate time-tagged control trajectories. In order to achieve this embedded 
functionality, the built in program Lab VIEW will be used. Lab VIEW is central to 
National Instruments approach to engineering and science applications. Lab VIEW is a 
development environment with a graphical programming syntax to visualize, create, and 
code engineering systems. Additionally, Lab VIEW is designed to interoperate with other 
software to ensure multiple tools are available to the user from a central platform [26]. 

The cRIO and IMUs were powered by a separate power supply providing 24 
VDC. Power was routed through a distribution board to each IMU and the cRIO. 
Figure 50 illustrates the power distribution board. The two DC-DC converters provide 
outputs of + 12VDC and +5VDC to power the various devices. 
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Figure 50. Power Distribution Board 


Additionally, an Ethernet cable is connected from the cRIO to the host computer 
for monitoring and post-processing. Subsequent theses in support of this project will 
incorporate a housing for a 24 VDC battery as well as components to communicate 
wirelessly with the host computer. This will enable the test bed to be completely free of 
external cables and wires; therefore, no external torques from hanging cables will be 
applied to the overall system. 

1, Lab VIEW IMU Integration 

In order to capture and display IMU output, the Lab VIEW program was used. 
Lab VIEW has a graphical coding environment similar to Simulink. A download from the 
National Instruments website support page was used to provide an example graphical 
block set that could be used to stream serial data [27]. Minor changes were made to the 
code in order to write the data from each IMU to a text file. Eigure 51 illustrates the code 
block that was used while Eigure 52 shows the front panel display for each port of the 
serial data module. Eor this test rig, three ports are used, one for each IMU. 
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Figure 51. Lab VIEW Continuous Serial Data code for IMU DATA. Source: [27]. 



Figure 52. Lab VIEW Continuous Serial Data Front Panel for IMU Data. 

Source: [27]. 
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2, Collecting IMU Measurements 

To collect and view the data, the “run” button on the front panel is clicked and 
serial data begins to stream. Once the experiment has completed, “stop program” is 
selected, and the first of three windows appear. Each window saves the serial data from 
the IMUs into separate text files for post-processing. 

3, Lab VIEW Robotic Arm Model Development 

The utility and capability of Lab VIEW was not just in the serial data processing, 
but also in the interface with robotic actuators. Code to read and display commands to the 
actuators was found in a National Instruments discussion forum. LabVIEW has 
compatibility with the Robotis MX-106 actuators. The LabVIEW code to implement the 
optimal control trajectory to the robotic actuators was created with the assistance of the 
National Instruments discussion forum and intern assistance [28]. These actuators are not 
as complex as the M42-10-S260-R actuators of the robot arm, but are useful in 
demonstrating the initial process and capability of LabVIEW to implement optimal 
control paths. Drivers for the more capable M42-10-S260-R actuators are needed for use 
in the LabVIEW environment. Not having the drivers restricted the ability to perform 
experimentation with these actuators. A note to the reader, in the process of developing 
the test rig, two of three M42-10-S260-R actuators that were to be used were damaged 
and therefore were not able to be used for experimentation. The actuator that was not 
damaged was mounted to the robot arm base to perform the experimentation discussed in 
Chapter IV. Due to the hardware issue only one DOE could be actuated for the tests. 
Eigure 53 illustrates the graphical code that could be later extended to drive the M42-10- 
S260-R actuators. 
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Figure 53. Robotic Motor Control Lab VIEW Code. Source: [28]. 


D. DATA POST-PROCESSING PROCEDURES 

1, Beginning Processes for Concepts A and B 

To read the data from the sensors, software from Arduino was used to program 
Razor’s microprocessor. The Arduino software provides a means to read accelerometer, 
magnetometer, and gyroscope data via a serial monitor [21]. Arduino itself does not have 
tools to plot the data received from the Razor. There is a means to view serial data 
graphically, but it is for real-time use only and not for post-processing needs. The user is 
required to develop a means to read the serial data into other programs such as MATLAB 
for analysis. Without editing the Arduino code, the serial monitor displays yaw, pitch and 
roll angles calculated from the nine inputs received from the Razor. In order to capture 
the data, the code for the serial monitor display was edited to display only raw 
acceleration measurements. The Arduino user interface provides a relative easy means to 
make such edits as discussed earlier. 
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Once the serial monitor displayed only aecelerations for each axis, further edits 
were made such that only the axis exeited by the movement from the two-link arm would 
be displayed. With the serial monitor now displaying the single, exeited axis values, 
experiments could be conducted with the goal of measuring the motion induced on the 
flexible link due to movement of the robot arm. For the initial testing of each concept, the 
maximum torque possible, 5.6 Nm/actuator, from the Dynamixel M42-10-S260-R 
actuator was applied. The trajectory of the two-link arm displaced the linkage 
approximately 160 degrees; that is, the movement of the two-link arm was displaced from 
one side to the other and vice versa. Figure 54 shows the lab test bed where the two-link 
eleetrically aetuated arm is on the right and the one-link arm with flexible joint is on 
the left. 



Figure 54. Lab Test Bed—Early Stage of Completion 
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To plot the data, the following proeess was condueted. First the serial monitor 
displayed the data as diseussed previously. With this said, it should be understood by the 
reader that the serial monitor eontinuously displays data from the Razor; that is, onee 
initialized, the Razor will continue to produce data, moving or not, until the USB is 
disconnected from the test bed computer. Therefore, the basic method to capture the data 
was to send a command to the two-link arm via the Robotis software, allow the flexible 
joint arm time to settle and then disconnect the USB from FTDI breakout board. From 
this point, the serial monitor freezes. The data displayed on the serial monitor was then 
copied and pasted into MATLAB for analysis. 

2, Refined Post-process Development 

As mentioned previously, there was an accepted delay in the design and 
manufacturing of the machined helical spring. Once the beginning processes proved the 
test bed’s basic functionality worked; that is, the robotic arm imparted a torque on the 
opposite flexible joint link arm, a more refined, robust procedure was developed to aid in 
the post-processing procedures for concept C, but more importantly to construct a means 
to evaluate several IMUs at once as well. The NI cRIO allows the user to do this. 
Figure 55 shows the final test bed construction. 



Figure 55. Lab Test Bed—Final Stage of Completion 
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The main limitation of the cRIO is that there is not a means to ealibrate the IMUs 
nor upload the Arduino eode to the IMU after the calibration and desired data for display 
has been entered. With this said, similar to the initial process, a separate laptop was used 
to perform this step of the process. Once the Arduino code was uploaded to each IMU, 
they were then secured to the test bed and connected to a RS232 connector, which was 
then connected to the NI cRIO. 

The initial measurement techniques focused on monitoring the tangential 
acceleration of the vibrating arm to gain a sense of the system performance. However, it 
was determined that the analysis also required additional components of acceleration and 
gyroscope data to be captured. The actual angular displacement of the vibrating arm was 
desired as well to provide a visual sense of the experiments. This would confirm that, 
with simple time-series integration, the acceleration data could be processed to produce 
the angular motion that was being observed. Several iterations to obtain success had to be 
performed. 

A typical experiment would be conducted by commanding the robotic arm 
through some trajectory. This imparts a torque and subsequent motion on the free- 
floating plate in the opposite direction of the robotic arm movement. This causes the 
vibrating arm to initially displace in the opposite direction of the plate. As the arm 
vibrates, its motion imparts subsequent torques on the plate until the motion is completely 
damped. 

Initially, it was thought that the tangential acceleration could be sensed at the end 
of the vibrating arm and then mapped to the angular motion of the flexible joint by the 
rotational mechanics (4.1) and (4.2). 


a, = a* r 

(4.1) 

a = aj r 

(4.2) 


where a is in units of rads/sec^. Then if the plate tangential accelerometer could be 
mapped to the center of the plate in a similar manner, the plate angular acceleration could 
be subtracted from the vibrating arm angular acceleration and then double integrated to 
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give the position angle of the flexible appendage. As it turns out, simply double 
integrating aeeeleration to obtain position produees invalid results due ignoranee of the 
velocity and position initial conditions [28]. 

Figure 56 illustrates the erroneous results obtained from initial testing of concept 
C. The figure shows a comparison of integrated accelerations obtained by a numerical 
integration code written in Excel to MATLAB’s cumtrapz [29]. 


Experimentally Derived Velocity Analysis - 



Experimentially Derived Position Analysis - 



Figure 56. Experimental Data Analyzed by Double Integrating Raw 

Accelerometer Data 


At first glance, the results of Eigure 56 appear to make sense. When the 
experiment is conducted, the motion of the robot arm causes the plate to freely rotate 
while the flexible joint arm is vibrating. When the flexible joint arm stops vibrating, the 
plate continues to drift as is observed in Eigure 56. However, the fact that velocity was 
“drifting” as well, that is increasing in this case, didn’t make sense. To investigate this 
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“drift” phenomenon, a simple sine wave was double integrated via a Simulink model. 
Figure 57 depiets the model used. 



To Workspace2 


Figure 57. Simulink Model of a Double Integrator System 

Figure 58 illustrates the results of the Simulink simulation assuming zero-initial 
conditions on velocity and position. 



Position 



Time (sec) 


Figure 58. Double Integrating a Sine Wave without Accounting for 

Initial Conditions 
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Though velocity has the same sinusoidal shape of the acceleration plot, notice that 
its amplitude has shifted up introducing a drift error. The position plot in Figure 58 is the 
most apparent that something is wrong. Calculus tells us that the resultant plot should 
return a sinusoidal result as seen in the acceleration curve. Yet, the position drifts as seen 
in Figure 58. The same simple sine function was double integrated via numerical 
integration methods, a user created algorithm and MATLAB’s cumtrapz function as a 
check on the Simulink results. Both simulations produced the same results as in 
Figure 58. 

It turns out that this phenomenon is more common then realized and is discussed 
in detail in [30]. The problem is that when integrating acceleration data twice to produce 
position data, the exact initial conditions to derive the position from velocity are 
unknown. With time-series data, one does not know how much to shift the data or at what 
time-series data point to accurately account for the initial conditions of the second 
integration which leads to position determination. The resulting position plot provides 
erroneous data. 

To verify the above arguments, another simulation was performed. In a Simulink 
model, the user can input the initial conditions as desired resulting in expected plots 
where velocity is out of phase with acceleration and furthermore position is out of phase 
with velocity, provided, as in Figure 59, that the correct initial conditions are selected. 
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Acceleration 




Figure 59. Double Integrating Sine Wave with Correct Initial Conditions 


To overcome this challenge, it was determined that the gyroscopic data could 
additionally be used. The method that was finally settled on to accurately represent the 
motion of the system was to first differentiate the gyroscope data to compute the angular 
acceleration. This operation in MATLAB is performed as: 

acceleration data = 

diff(time') 

Once each angular acceleration was obtained, the data was numerically integrated 
with cumtrapz to obtain angular rate, and then once more to obtain angular position data. 

1. rate = cumtrapz {acceleration) 

2. position — cumtrapz {rate) 

The results of this process as applied to concept C are discussed in Chapter V. 
Frankly it is a peculiar outcome considering previous numerical methods gave erroneous 
results; however, the process above does produce the observed results. The explanation is 
that differentiating the gyro data to obtain an angular acceleration and then integrating to 
arrive back at angular rate allows drift to be corrected because of the mismatch between 
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finite differentiating and the trapezoidal rule for integration. To attempt to reereate this 
phenomenon manually, the vibrating arm aeeeleration data was numerieally integrated to 
arrive at the plot in Figure 60. 


Vibrating Arm Anguiar Rate - 



Figure 60. Vibrating Arm Angular Rate by Numerically Integrating 

Acceleration Data 

Taking the initial and final y-axis values of the data in Figure 60 created the slope 
of the line. Figure 61 shows the slope transposed onto the plot in Figure 60. 


79 





Vibrating Arm Anguiar Rate with Siope - 



Time (sec) 


Figure 61. Vibrating Arm Angular Rate with Slope Overlay 

The slope array was added to the vibrating arm angular rate data. This addition is 
the manual approach to removing the slope bias error incurred from the initial cumtrapz 
numerical integration. However, the problem is that the final value of the vibrating arm 
angular rate is accurate in MATLAB to four significant digits. To form a data series for 
the slope with its length equal to the time array, the time steps between each data point 
will have a small error of accuracy. Therefore, the slope data series end point will have a 
slightly different value than the original data’s end point. 

vib arm data corrected — vib arm data + slope 

Figure 62 shows the results of the vibrating arm angular rate data compared to the 
process eventually used in the final experiment. One can see that the plot adjusted for 
slope is not smooth due to the error present in computing and then adding the slope 
adjustment. 
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Vibrating Arm Anguiar Rate Adjusted for Siope 



-120 - 1 - 1 -^^^^^- 

012345678 

Time (sec) 


Figure 62. Vibrating Arm Angular Rate Adjusted for Slope Compared to Method 

of Determining Rate from Differentiating Gyro 

With the plot correeted for the slope bias, the data was numerically integrated 
again with cumtrapz to arrive at the vibrating arm position data. 

vib postion — cumtrapz(vib arm data corrected) 

Figure 63 shows the results of the slope adjustment compared to the method that 
was ultimately used in the final experimental process. The small amount of error in the 
rate data contributes to the inaccuracies of the position data. While the results of 
manually accounting for the bias do not produce results as accurate as the real-world 
motion of the test bed compared to differentiating the gyro data, the plot is comparable 
and certainly better than not accounting for slope or initial conditions. This result also 
confirms the notion that by differentiating and then integrating the gyroscope data the 
bias slope is effectively canceled out. Additionally, the lower plot of Figure 63 adds a 
comparison of the increased error propagated through when simply double integrating the 
acceleration data and not accounting for the slope or initial conditions. 


81 










Position of Arm with Siope Adjustment 



Position of Arm after Adjusted for Siope Compared to 



Time (sec) 


Figure 63. Position of Vibrating Arm when Adjusted for Slope Compared to 

Alternate Methods 


For another comparison, the raw vibrating arm rate gyro data was numerically 
integrated to produce angular position. As discussed previously, when numerically 
integrated a plot with bias error is produced as seen in Figure 64. Additionally, Figure 64 
illustrates the slope associated with the trace. 
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Vibrating Arm Angular Displacement with Slope - 



Figure 64. Vibrating Arm Angular Displacement with Slope Overlay 

As in Figure 62, if the vibrating arm angular displacement plot, derived from raw 
rate gyro data, is transcribed to eliminate the drift produced from the bias error, a 
comparison can be made to the technique discussed previously of differentiating the rate 
gyro first. As one can see from Figure 65, the plots are nearly identical illustrating that 
both techniques can produce very similar results; however, performing the differentiating 
first eliminates the manual transcription approach. 
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Vibrating Arm Angular Displacement Adjusted for Slope 



-12 I-^^^^^^^-1 

01 2345678 

Time (sec) 

Figure 65. Vibrating Arm Angular Displacement Adjusted for Slope Compared to 
Method of Determining Position from Differentiating Gyro Data First 

E. IMU ANGLE MEASUREMENTS 

One last piece of data analysis was to compare yaw output from the Arduino code 
to the methods for determining system motion from acceleration and gyroscope data 
presented in this chapter. As discussed in the calibration chapter, the IMUs’ 
magnetometers were calibrated in accordance with the tutorial in reference [23]. The 
magnetometer data coupled with accelerometer data was used in Arduino to calculate the 
yaw, pitch, and roll of the IMU. The IMUs output was recoded to output the yaw data 
from each IMU. With this said, lower-cost IMUs such as the 9DOF Razor tend to be 
more susceptible to magnetic influences that in turn affect the output of the angle, or yaw, 
measurements. Figures 66-68 show the results of yaw data of the vibrating arm, plate, 
and robot arm compared to the methods used earlier to derive the system displacements. 
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Vibrating Arm Displacement Obtained from Raw Data 



Time (sec) 


Figure 66. Vibrating Arm Displacement Compared to Yaw Measurements 


Piate Dispiacement Obtained from Raw Data 



Figure 67. Plate Displacement Compared to Yaw Measurements 
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Robot Arm Displacement Obtained from Raw Data 



Time (sec) 


Figure 68. Robot Arm Displacement Compared to Yaw Measurements 

While the yaw data is somewhat comparable, it is not as accurate as using the raw 
acceleration and gyroscope data to derive the system motion. The visually observed 
experimental displacement seems to be closest to the processing technique that uses the 
method of differentiating the rate gyro data first. 

F. SUMMARY 

In Chapter IV, test bed instrumentation was introduced by illustrating the sensors 
used to capture the motion of the test bed appendages and plate. It also demonstrated how 
these signals are processed via the NI cRIO. Additionally, post-processing procedures 
were developed highlighting the pitfalls one may encounter by naively double integrating 
angular acceleration data to arrive at angular position. Furthermore, it was shown that 
using raw accelerometer or rate gyro data to compute motion data, such as angular 
position, are more beneficial than using the IMUs yaw measurements. 
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The discussion to follow in Chapter V demonstrates the results from the initial 
processes of concept A and B, and finishes with the fully developed process for analyzing 
the data from concept C, the primary experimental method moving forward. 
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V. LABORATORY EXPERIMENTS 


The previous chapters demonstrated the purpose and method to designing and 
constructing the experimental test bed. Chapter V presents some example responses from 
each of the designed flexible joint prototypes and compares and contrasts the suitability 
of each design. Insight into a path ahead for future theses is also presented. 

A. CONCEPT A—JOINT WITH TWO COUNTER SPRINGS 

Before experiments could be conducted, the accelerometers were calibrated in 
accordance with the tutorial of reference [18]. Once calibrated, static testing was 
conducted to determine if the flexible joints responded appropriately, that is, produced a 
damped oscillatory motion in response to the movement of the two-link arm. For the 
purposes of the static experiment, the applied force was performed by simply manually 
displacing the link and followed by release of the link. Figure 69 is a simple schematic of 
a top down view of the system setup with the base plate is fixed. This approach was used 
for testing both for concepts A and B. 


Manual force 
application 



Base Plate Fixed - Static Test 


Figure 69. Schematic of Setup for Static Testing Concepts A and B 
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Figure 70 shows the acceleration response measured for concept A. One can see 
from Figure 70 that the response after the link is released damps out as expected with an 
exponential decay in the amplitude of the vibration. Additionally, in Figure 70, the 
disparity in the response prior to damping is simply a reflection of the user’s input while 
displacing the link. The finding from this static experiment shows the flexible joint 
functions well enough to conduct experiments with air pressure applied to the base. 



Figure 70. Concept A—Static Test Response 


With the static test showing an appropriate response, experiments with pressure 
applied to the plate and input imparted by the two-link electrically actuated arm were 
conducted next. Figure 71 illustrates is a simple schematic of a top down view of the 
system when the base plate is floating and the input force to the system is applied via 
robot arm motion. This approach was used for testing concepts A and B. 
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Robot Arm Motion 




Base Plate Floating 


Figure 71. Schematic of Setup for Dynamic Testing Concepts A and B 

Figure 72 illustrates the measured acceleration with a free-floating plate. From the 
plot, one can clearly see the initial increase in acceleration, coincident with the initial 
acceleration of the actuators, followed by a deceleration when the two-link arm stops, and 
then finally a settling of the flexible joint. 
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Figure 72. Concept A—Dynamic Test Response 
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Figure 72 demonstrates a reasonable result. When a satellite arm moves, counter 
forces are transcribed to not only other appendages but also the entire spacecraft. On this 
test set, when electric actuators displace the two-link arm, the entire free-floating plate 
moves in the opposite in accordance with Newton’s 3’^‘^ law. Thus, the acceleration 
response includes a component due to the motion of the plate. In order to separate the 
two, an additional Razor IMU must be used to measure the motion of the plate as 
described in Chapter IV. 

B. CONCEPT B—SPRING FLEXION PIN 

Similar to concept A, the accelerometer for this concept was first calibrated, and 
then a static test was conducted. Figure 73 illustrates the results. 


Concept B Static Test 



Figure 73. Concept B—Static Test Response 


From the plot in Figure 73, one can see that the response for concept B damps the 

motion induced by the manually applied input in an expected fashion. In comparison to 

concept A, the response appears to die out more quickly indicating a more dominant 

viscous damping coefficient in the joint. This is a result of different spring coefficients 

used in the concept development as well the general design which affects the loading of 
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the joint bearings. Figure 74 illustrates the response when pressure is applied to the plate 
and the two-link arm is moved through its trajectory. 


Cone«f>t B Initial Teat 



Figure 74. Concept B—Dynamic Test Response 

Similar to the results for concept A, this plot demonstrates the initial acceleration 
of the two-link arm, followed by deceleration when the arm stops, and then a damped 
response. The damped response, similar to the static response, dies out faster compared to 
concept A, again due to the difference in springs used and the concept design. 

One obvious difference between the results of the static tests compared to the tests 
where the plate is floating and the robotic arm movement causes the excitation is the 
observed signal to noise ratio. It was mentioned earlier that during the calibration 
process, it was not possible to calibrate the accelerometers to zero due to noise inherent in 
each IMU. This noise is also referred to as sensor drift caused by a small DC bias in the 
acceleration signal [30]. The amplitude of the static experiments is large in comparison to 
the floating plate tests; therefore, the noise is not as apparent in the results. The signal to 
noise ratio is large. When the signal to noise ratio is small on the other hand, it is difficult 
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to discern the vibrating arm motion from the noise output of the sensor and therefore one 
can’t perform proper analysis of the results. With this said, eoncepts A and B seem to be 
inadequate for permanent implementation on the test bed. 

C. CONCEPT C—MACHINED TORSION SPRING 

Coneept C incorporated the helical machined spring as the flexible joint. This 
concept allows for pure moments and linear rates. As noted in Chapter III.c, the 
manufacturers produced a torsion spring rate that resulted in a spring that was too stiff to 
provide the expected displacement. The spring was subsequently trimmed at the NPS 
machine shop to provide increased deflection. Additionally, 500-gram weights were 
added to the end of the robotic arm and then vibrating arm to add increased inertia to the 
system. Adding the weight contributed to an enhaneed signal to noise ratio so the 
experimenter can observe the results more elearly by reducing the noise floor. Figures 75 
and 76 show the test bed configured for the final experiments with added weights. 



Figure 75. Test Bed Configuration for Final Experiments 
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Figure 76. Close-up View of Weight Added to the End of Vibrating Arm 

The first step for the final experiments was to upload the Arduino code onto each 
IMU to display all three components acceleration and gyroscope data. Ultimately only 
tangential data is needed. However, the plate IMU is laid flat while both arms’ IMUs are 
vertical; therefore the output channels from each IMU are different depending on 
orientation. Additionally, post-processing the data to determine the gravity component 
can be used to verify the accuracy of the processed data. 

An experiment was conducted by opening the front panel of the Lab VIEW 
program as well as the Robotis Dynamixel Wizard software to control the Dynamixel Pro 
M42-10-S260-R. Again, just one actuator was functioning for the final experiment; 
therefore, the two-link robotic arm in effect functioned as a one-link arm. On the 
Lab VIEW front panel, the “run” button was selected then serial data from each IMU 
began to stream onto the display. The serial data is separated by 20 milliseconds; with 
this said, in order to reduce the amount of data for post-processing, the robotic arm was 
quickly commanded to rotate 90 degrees. The robotic arm motion imparts rotational 
motion on the plate and therefore a vibration of the flexible-joint, vibrating arm. Once the 
vibrating arm settles, the Lab VIEW program is commanded to stop. The data from each 
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IMU is subsequently written to text files, the data is eopied and pasted into Exeel, 
transposed, and finally eopied into the MATLAB seript detailed in the Appendix. 

Experimental Results 

Figures 77-79 illustrate the aeeeleration data from eaeh axis of the respeetive 
IMUs. The vibrating arm and robotie arm data sets both illustrate that the axis normal to 
the plane of motion is the “al” eomponent and the plate normal aeeeleration eomponent 
is “a2” sinee the data plotted corresponds to gravity in metric units. Additionally, the 
tangential motion component for each arm is “a2” whereas the plate tangential 
acceleration component is “al” by inspection of the sinusoidal behavior of the plots. 


Vibrating Arm Acceieration Measurements 


O I O ^ 

O O 



.4 I-^^^^^^^-1 

012345678 

Time (sec) 


Figure 77. Vibrating Arm Acceleration Measurements 
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Plate Acceleration Measurements 




Figure 78. Plate Acceleration Measurements 
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Robot Acceleration Measurements 
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Figure 79. Robot Arm Acceleration Measurements 
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Figures 80-83 present the rate gyro data for the test. The vibrating arm and 
robotic arm results illustrates that the desired angular rate component is “gl” and for the 
plate, the desired angular rate component is “g2”. To note, in both the acceleration and 
rate plots, one can see how the robotic arm is commanded comparably to a “bang-bang” 
maneuver. That is, the responses show a rapid application of torque to the system 
followed by a rapid deceleration. This effect is translated to the plate, and then to the 
vibrating arm. 



Figure 80. Vibrating Arm Rate Measurements for Each Axis 
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Plate Gvro Measurements 
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Figure 81. Plate Rate Measurements for Eaeh Axis 
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Figure 82. Robot Arm Rate Measurements for Eaeh Axis 
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Figure 83 compares the vibrating arm angular acceleration response obtained by 
two methods. The “Alpha from differentiating gyro” is the angular acceleration derived 
by finite differencing the rate gyro data. The “Raw alpha from accelerometer” trace is 
simply the tangential acceleration mapped to the vibrating arm’s flexible joint by dividing 
by the distance from the accelerometer to the center of the joint. 



Figure 83. Vibrating Arm Acceleration Determined from Differentiated Rate 
Gyro Data versus Raw Acceleration Data Mapped to Joint 

Figures 84 and 85 represent the angular acceleration for the plate and robot arm, 
respectively. The plots were derived in the same manner as for the vibrating arm. As 
noted previously, the rapid on/off application of the robotic arm is easily seen in the 
angular acceleration plots for both the plate and robot arm. Note also the comparably 
large angular acceleration magnitude of the robot arm in comparison with the other 
signals. 
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Figure 84. Plate Acceleration Determined from Differentiated Rate Gyro Data 
versus Raw Acceleration Data Mapped to Joint 



Figure 85. Robot Arm Acceleration Determined from Differentiated Rate Gyro 
Data versus Raw Acceleration Data Mapped to Joint 
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Figure 86 illustrates the angular velocity of the vibrating arm derived via three 
different approaches. The “raw gyro” plot is simply that, the raw data converted into units 
of °/sec. The “rate from diff gyro” was determined by numerically integrating the finite 
differenced gyro data noted in Figure 83. The “rate from accel” is the angular 
acceleration signal derived from the tangential acceleration component numerically 
integrated. The plot of raw gyro data compared to the “rate from diff gyro” confirms the 
process of differentiating to derive the angular acceleration and then integrating to derive 
the angular rate by canceling out the +/- errors of each step in the process. The “rate from 
accel” plot confirms the discussion in Chapter IV that simply numerically integrating the 
data without accounting for the inherent bias in the process due to unknown initial 
conditions will cause the resultant plot to drift. 


Vibrating Arm Anguiar Rate - 
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Figure 86. Processing the Vibrating Arm Angular Rate from the Measured Data 

Figures 87 and 88 demonstrate similar results for the plate and robot arm. Again, 
the rapid onset of torque is easily observed in both figures. 
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Plate Angular Rate - 
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Figure 87. Processing the Plate Angular Rate from Measured Data 


Robot Arm Angular Rate - 
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Figure 88. Processing the Robot Arm Angular Rate from Measured Data 
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Figure 89 illustrates the vibrating motion. The “Pos from raw gyro” plot was 
determined by numerically integrating the raw gyro data. The “Pos from diff gyro” was 
determined by numerically integrating the previously mentioned differentiated gyro data 
that was then integrated to derive the angular velocity. Both methods show comparable 
results to the actual motion of the system. The motion of the vibrating arm, as seen in 
Figure 89, represents not just the motion of the arm, but also the motion of the arm plus 
the motion of the plate. That is, after the robot arm stops, the vibrating arm continues to 
vibrate imparting a torque onto the plate. However, the plate also drifts while the arm is 
vibrating. The combined motions explain the drift observed in Figure 89 while the 
vibrating arm vibrates and subsequently damps out. This point is important to note, as the 
drift in the “Pos from diff gyro” is the plate actually drifting vice the “drift” as a result of 
numerical integration. With this said, as will be seen when the vibrating arm and plate 
motions are separated, the “Pos from raw gyro” plot represents components due to actual 
plate drift and numerical integration drift. 


Vibrating Arm Displacement from Integrating Gyro Data 



Figure 89. Vibrating Arm Displacement from Integrating Gyro Data and from 

Integrating Differentiated Gyro Data 
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Figures 90 and 91 illustrate the motion of the plate and the robot arm derived 
using the same processing as Figure 89. In Figure 90, the error from numerically 
integrating the raw gyro data is more apparent as seen in the initial slope of the “Pos from 
raw gyro” plot. To note, for completeness the acceleration data from each IMU was 
numerically integrated twice. The results skewed the plots of the previously discussed 
methods to such a degree that they were unable to be read. That is, the error from 
integrating the acceleration twice was so large that it overshadowed the other plots, 
demonstrating that twice integrating accelerometer data is unusable unless one can 
properly account for the slope and initial conditions associated with each integration. 


Plate Displacement from Integrating Gyro Data 



Figure 90. Plate Displacement from Integrating Gyro Data and from Integrating 

Differentiated Gyro Data 
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Robot Arm Displacement from Integrating Gyro Data 



Figure 91. Robot Arm Displacement from Integrating Gyro Data and from 

Integrating Differentiated Gyro Data 

Figure 92 illustrates the results of isolating the vibrating arm motion from the 
plate motion. The figure demonstrates that differentiating the raw gyro data first then 
integrating the result twice is clearly the best available method for eliminating the drift 
error and therefore to isolate the vibrating arm motion. The “Pos from raw gyro” 
approach still has a bias present after the plate motion is subtracted from the vibrating 
arm motion due to the differences in error present in this approach. The MATLAB code 
below demonstrates the simple code used to isolate the vibrating arm motion where 
“Subtract raw” subtracts the plate displacement determined by integrating the raw gyro 
data from the vibrating arm raw gyro data. “Subtract accel” performs a comparable 
operation for the method of differentiating then integrating the raw gyro data. 

subtract_raw = vib_pos_gyro_raw - plate_pos_gyro_raw; 

subtract accel = vib_pos_rate_gyro_accel - plate_pos_rate_gyro_accel; 
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Isolated Displacement of Vibrating Arm 



Figure 92. Isolated Displacement of Vibrating Arm from Plate Displacement 

D. SUMMARY 

This chapter illustrated that the three concepts developed for implementing a 
flexible joint built upon themselves in a crawl, walk, run fashion to produce a viable 
design and flexible joint mechanism to support future experiments. The helical torsional 
spring ultimately did produce the desired deflection. Additionally, the developed post¬ 
processing for the IMU data was able to accurately isolate and depict the actual motion of 
the system observed during the experiments. 


107 










THIS PAGE INTENTIONALLY LEET BLANK 


108 



VI. CONCLUSION 


A. CONCLUSION 

The goal of this thesis was to develop multiple coneepts for a flexible joint motion 
simulator, from simple to more eomplex, to provide a basis for laboratory 
experimentation on advaneed algorithms. As unique or elever a design eoneept may be, 
proper effort needs to be plaeed into the sensing proeesses such that useful data can be 
extracted from experiments. Ultimately three mechanism concepts were investigated. 
Concepts A and B were preliminary ideas developed to test the basic functionality of the 
air-bearing test bed, test for the expected motion of the system as a whole, and to develop 
initial post-processing data analysis work flows. The responses of concepts A and B in 
both the static and dynamic testing proved to be far from ideal. Because the deflection 
amplitude was small, the noise from the IMUs was more apparent. Concept C proved to 
be the best design. Concept C’s flexible joint incorporated a helical torsion spring 
allowing linear rates and pure moments to be realized. Once concept C was assembled, it 
was apparent that good signal to noise ratios could be obtained. Experiments were 
performed by incorporating the NI cRIO and refined post-processing steps in order to 
measure link flexible effects. The responses in all cases were sufficient to provide an 
understanding of spacecraft dynamics and vibration analysis when the motion of one 
body excites other components of the spacecraft. Additionally, the efforts made to this 
point serve to provide the basis necessary to proceed with more complex thesis work 
incorporating optimal control theory. Future work will be aimed at finding optimal robot 
arm motions that can be accomplished in minimal time and/or with minimal effort, that 
also reduce the induced vibrations of other attached antenna linkages. To do this, a model 
of the system as a whole should be considered. 

B, FUTURE WORK 

The developed test bed provides opportunities for a variety of flexible space 
system experiments. Through optimal control applications, one can research the effects of 
robotic arm motion on the behavior of flexible appendages. 
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Further development of the sensing proeesses and software environment should 
be made to better understand the responses of the system. Furthermore, understanding of 
the Robotis software used to eommand the Dynamixel actuators would allow one to 
implement optimal control trajectories to the two-link robot with the goal to minimize the 
amount of vibration on the flexible joint link. 

Additionally, the plate was created to allow for three stanchions to be assembled 
to the plate and then attach a second level for additional components. With pressure 
applied to the plate and when the two-link arm was displaced by a commanded trajectory, 
the base plate moved in the opposite direction of the arm displacement, as one would 
expect. This fact is noted as a complexity of spacecraft dynamics. As a satellite is floating 
through space, movements from attached bodies are felt throughout the spacecraft. The 
complexity of incorporating momentum exchange devices to counter this movement is 
not lost on the author. The laboratory test bed that has been built can provide a means to 
incorporate such devices on future theses. As well, the NI cRIO has 12 more ports for 
many other devices to be incorporated into the test bed. Furthermore, the laboratory setup 
can be evolved using Wi-Fi components. Wireless communication between the sensors 
and the working computer will eliminate the issue of hanging cables imparting torques on 
to the test bed. 

Until that end, the efforts made so far in the build, experimentation, and 
understanding of flexible spacecraft systems have laid the groundwork for more complex 
and integrated experiments in this laboratory environment. In all, the possibilities that this 
test bed provides are very exciting and ready for the next student! 
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APPENDIX. EXAMPLE DATA PROCESSING CODE 


In this appendix, numerical integration code was created to attempt to mimic the 
numerical integration function of Matlab’s “cumtrapz” function. The displayed plots 
compare the results of the two methods. 

Due to the size/length of the time, acceleration, and gyroscope data arrays, they 
were deleted from the appendix. A has been added to highlight the change. This data 
changes with each experiment; therefore, the critical piece to the coding is still 
represented. 


% simple model to show problems with double integrating acceleration. 

% This code performs numerical integration of experimental data and 
% compares it to Matlab's cumtrapz function. As well, a simple Simulink 
% model was created to show the results from passing a sine input 
through a 

% double integrator compared to passing the same simple sine wave 
through 

% Matlab's cumptrapz function. 

% CDR Martin Griggs 
% Thesis - 31 Oct 2016 


clear all; close all; 

%%% Run Simulink model %%% 

[tout, yout, output]=sim( 'tests ') ; 

%% Experiment Data analized using numerical integration code 
vib_accel_0 = [*]; 
vib_accel_l = [*]; 
vib_accel_2 = [*]; 


vib_accel_0 = vib_accel_0*l/225*9.81; %for +/- 16g full scale, we 
should divide by 256 LSB/g 

%by instead we divide by 225 which 


gives Ig 


%in "z" direction per the "raw" data 
%(see also ADXL345 product 


specification) 

vib_accel_l = vib_accel_l*l/225*9.81; 
vib_accel_2 = vib_accel_2*l/225*9.81; 


time = [ * ] ; 

dt = 0.02; 

time = time(1:381); 
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length_vib = length(vib_accel_2); 

% Vibrating Arm Velocity 

vib_vel(l) = 0.5*(vib_accel_2(1) + vib_accel_2(2))*dt; 
for i = 1:length_vib-3; 

vib_vel(2) = 0.5*(vib_accel_2(2) + vib_accel_2(3))*dt + vib_vel(l) 
vib_vel(i+2) = 0.5*(vib_accel_2(i+2) + vib_accel_2(i+3))*dt + 
vib_vel(i+1); 

end 

v_size = size(vib_vel); 

vib_vel(v_size(2) + 1) = vib_vel(end); 

% Vibrating Arm Displacement 

vib_displ(l) = 0.5*(vib_vel(1) + vib_vel(2))*dt; 
for j = 1:length_vib - 3; 

vib_displ(2) = 0.5*(vib_vel(2) + vib_vel(3))*dt + vib_displ(1); 
vib_displ(j+2) = 0.5*(vib_vel(j+2) + vib_vel(j+3))*dt + 
vib_displ(j+1); 

end 

d_size = size(vib_displ); 

vib_displ(d_size(2) + 1) = vib_displ(end); 

%% Experimental Data using cumtrapz - only accounting for tangential 
acceleration (accel [2]) 

vib_vel_cum = cumtrapz(time, vib_accel_2); 
vib_pos_cum = cumtrapz(time, vib_vel_cum); 

%% Plots for numerical versus cumtrapz 
figure 

subplot(2, 1, 1) 

plot(time, vib_vel, time, vib_vel_cum, 'Linewidth' , 2) 

xlabel('Time (sec)') 

ylabel( 'Velocity (meters/sec)') 

legend( 'Numerical Integration Code', 'Cumtrapz') 

title({' Experimentally Derived Velocity Analysis 'Numerical vs. 

Cumtrapz' }) 

subplot(2, 1, 2) 

plot(time, vib_displ, time, vib_pos_cum, 'Linewidth', 2) 
xlabel('Time (sec)') 
ylabel (' Position (meters)') 

legend( 'Numerical Integration Code', 'Cumtrapz') 

title({' Experimentially Derived Position Analysis 'Numerical vs. 

Cumtrapz' }) 

%% Cumtrapz simple sine wave 
c = 0:0.1:20; 

acceleration_cum = sin(c); 

velocity_cum = cumtrapz(c, acceleration_cum); 
position_cum = cumtrapz(c, velocity_cum); 


%% Plots of simple sine wave passed through simulink and corrected for 
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intital conditions compared to 

% cumtrapz 

figure 

subplot(3, 1, 1) 

plot(tout, acceleration, 'Linewidth', 2) 
xlabel('Time (sec)') 
ylabel( 'Acceleration (rads/sec^2)' ) 
title( 'Acceleration' ) 
subplot(3, 1, 2) 

plot(tout, velocity, 'Linewidth', 2) 

xlabel('Time (sec)') 

ylabel( 'Velocity (rads/sec)') 

title( 'Velocity' ) 

subplot(3, 1, 3) 

plot(tout, acceleration, 'Linewidth', 2) 
xlabel('Time (sec)') 
ylabel (' Position (rads)') 
title( 'Position' ) 

figure 

subplot(3, 1, 1) 

plot(c, acceleration_cum, 'Linewidth', 2) 
xlabel('Time (sec)') 
ylabel( 'Acceleration (rads/sec^2)' ) 
title( 'Acceleration' ) 
subplot(3, 1, 2) 

plot(c, velocity_cum, 'Linewidth', 2) 

xlabel('Time (sec)') 

ylabel( 'Velocity (rads/sec)') 

title( 'Velocity' ) 

subplot(3, 1, 3) 

plot(c, position_cum, 'Linewidth', 2) 
xlabel('Time (sec)') 
ylabel (' Position (rads)') 
title( 'Position' ) 
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